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ABSTRACT 


A  linear  control  subroutine  library  was  created  and 
stored  in  a  load  module  on  Disk  02  of  the  IBM/360  of  the 
Naval  Postgraduate  School. 

This  library  consists  of  three  groups  of  programs: 
transfer  function  subprograms;  matrix  manipulation  and  time 
response  subprograms;  and  modern  control  design  routines. 
The  transfer  function  subprograms  provide  numerical  aids 
for  classical  control  design  techniques  including  root  locus 
and  frequency  design  methods.   The  matrix  manipulation  and 
time  response  routines  allow  the  user  to  determine  eigen- 
values, find  state  transition  matrices,  evaluate  resolvent 
matrices ,  perform  several  other  matrix  operations  and 
determine  and  plot  graphical  time  responses.   The  modern 
control  design  programs  aid  in  solving  Linear  Quadratic 
Gaussian  (LQG)  problems  and  also  provide  the  capability  to 
investigate  sensitivity  and  to  de-couple  multi-input  multi- 
output  systems. 

This  thesis  is  a  user's  manual  for  the  library  of  control 
design  programs.   Applications,  extensive  documentation  and 
numerous  worked  examples  are  included. 
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I.   INTRODUCTION 

A  large  number  of  computer  programs  are  available  to 
help  today's  control  system  engineers  analyse  and  design 
increasingly  complex  systems.   Most  of  these  programs,  how- 
ever, are  available  in  the  form  of  listings  only,  so  any 
one  wishing  to  use  them  must  punch  the  cards,  compile  and 
test  the  routines,  modify  them  and,  most  of  the  time,  load 
them  everytime  a  problem  is  to  be  solved.   Obviously  this  is 
not  a  very  practical  and  efficient  way  of  using  computers. 

The  intent  of  this  thesis  was  to  facilitate  the  use  of 
several  of  these  programs  by  making  them  easily  accessible 
to  all  users  as  a  pre-compiled  load  module  library.   The 
features  of  the  library  were  to  be  as  follows: 

-  easy  access  to  the  subprograms 

-  only  rudimentary  knowledge  of  FORTRAN  coding  and  card 
set  up  procedures  required  to  use  the  subprograms 

-  good  documentation  readily  available  to  the 
users  (complete  with  subprogram  descriptions,  card 
set  up  procedures  and  worked  out  examples) 

-  an  expandable  and  improvable  library 

-  good  priority  categories  (class  A  or  B  only) 
for  quick  turnaround. 

Using  these  features  as  guidelines,  a  linear  control  sub- 
routines library  (LINCON)  was  created,  tested  and  is  now 
available  to  any  user  on  the  Naval  Postgraduate  School  IBM/360 


13 


The  following  chapters  describe  the  computer  procedures 
and  present  these  linear  control  subprograms  contained  in 
the  library.   All  the  different  aspects  of  deck  preparation 
and  job  control  cards  are  discussed.   The  most  common  error 
conditions  that  may  occur  while  using  the  subprograms  and 
the  remedial  actions  to  be  taken  are  pointed  out.   The  linear 
control  subprograms  are  presented  in  a  user-oriented  fashion. 
They  are  first  introduced  by  defining  their  purposes  and 
indicating  the  general  rules  that  apply.   Then  the  subpro- 
grams are  individually  described.   The  input  requirements 
and  the  output  to  be  expected  are  presented  in  great  detail. 
Several  examples  are  worked  out,  complete  with  the  control 
cards,  the  input  data,  the  computer  output  and  the  interpre- 
tations of  the  results. 

Note  that  the  programming  aspects  of  the  work  are  not 
included  in  the  presentation.   Reference  1,  the  provenance 
of  most  of  the  subprograms  that  constitute  the  LINCON  library, 
must  be  consulted  in  that  regard,  along  with  the  actual 
listings  of  the  subroutines.   Also  note  that  reference  1 
can  be  used  as  an  alternative  source  of  information  in 
using  the  subprograms. 

However,  Appendix  A  explains  how  the  LINCON  data  sets 
were  created  and  gives  the  job  control  cards  required  to 
modify,  verify  or  erase  the  data  sets.   Information  on  how 
to  recreate  the  library,  should  it  become  necessary,  are  given 
as  well.   Finally,  Appendix  B  specifies  the  references  from 
which  the  worked  examples  were  taken. 
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II.   COMPUTER  PROCEDURE 

The  programs  and  subprograms  described  in  [1] ,  or  modified 
versions,  together  with  a  few  locally  written  programs  were 
assembled  in  a  load  module  to  form  a  subroutine  library.   A 
private  user  disk  space  was  allocated  on  Disk02  of  the  Naval 
Postgraduate  School  IBM/360  computer  to  hold  the  partitioned 
data  set  and  library  procedures  were  defined  and  cataloged  so 
the  library  could  be  accessed  by  any  computer  user  under  OS 
Batch.   The  details  on  how  to  access  the  library  and  use  the 
subprograms  and  subroutines  are  presented  in  the  following 
paragraphs  and  a  complete  description  of  the  data  set,  along 
with  pertinent  computer  procedure  information,  is  given  in 
Appendix  A. 

The  system  was  devised  in  such  a  way  as  to  minimize  the 
need  for  programming  and  provide  the  user  with  a  convenient, 
flexible,  easy-to-utilize  tool  for  analysis  and  design  of 
linear  control  systems.   The  programs  and  subprograms  were 
kept  as  separate  subroutines  so  one,  or  more,  programs  could 
be  executed  as  a  single  job.   The  following  gives  a  detailed 
description  of  the  different  methods  of  accessing  the  library 
as  well  as  the  cards  necessary  to  run  the  programs  under  batch 
processing.   For  convenience,  the  major  steps  of  the  proce- 
dure are  also  reproduced  in  Section  III  as  part  of  the  sub- 
programs presentation. 
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A.   MODES  OF  OPERATION  AND  CONTROL  CARDS 

There  are  many  different  operating  modes  a  user  can 
employ  to  access  a  given  computer  library.   Of  these  methods, 
three  were  determined  to  be  most  appropriate  and  are  presented 
hereafter.   It  is  pointed  out  that  these  procedures  only 
apply  to  this  specific  set  of  programs,  which  was  assigned  the 
name  LINCON  (for  linear  control) .   Also  observe  that  each  mode 
implies  the  use  of  slightly  different  control  card  deck  set 
ups.   These  differences  are  essential  to  the  proper  operation 
of  the  system  under  the  selected  mode  of  operation.   Each  line 
must  be  meticulously  reproduced  on  the  computer  card  and  the 
order  of  appearance  of  the  cards  scrupulously  respected. 
1.   Mode  One 

This  mode  applies  when  a  user  wants  to  execute  only 
one  of  the  subprograms  for  either  single  or  multiple  runs. 
Except  for  the  subprograms  named  GTRESP,  KALMAM  and  PRTLOC, 
which  require  exterior  subroutines,  all  subprograms  can  be 
accessed  using  this  method.   Mode  Two  establishes  the  proce- 
dures that  deal  with  the  three  special  cases  enumerated  above. 

For  Mode  One,  the  control  cards  must  be: 
//  (standard  OS  JOB  card) 
/A  EXEC,,  LINCON 
//LINK.SYSIN^DD  * 
~„ INCLUDE^SYSLIB (member) 
/* 
//GO.SYSIN^DD,,  * 
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data  deck  as  described  in  Section  III 
for  the  subprogram  "member" 

/* 

where  "member" is  the  simple  name  defining  a  subprogram  to 
be  executed.   For  example,  "include  syslib ( SERCOM)  "  would 
have  to  be  typed  on  the  appropriate  card  to  access  the  sub- 
routine library  program  called  SERCOM. 
2.   Mode  Two 

The  three  special  cases  previously  mentioned  are 
accessed  using  this  mode  of  operation.   A  different  library 
procedure  was  created  since  GTRESP,  KALMAN  or  PRTLOC  might 
very  well  require  special  functions  or  inputs  that  vary  as 
given  parameters  change.   This  situation  does  not  significantly 
complicate  the  procedure  and  greatly  adds  to  the  system  capa- 
bility.  Further  justification  and  explanation  are  given  in 
Section  III  along  with  the  subprogram  descriptions.   Again 
under  this  second  mode/  the  programs  are  to  be  accessed  one 
at  a  time,  either  for  single  or  multiple  runs.   The  computer 
card  deck  set  up  to  be  provided  is: 
//  (standard  OS  JOB  card) 
//AEXECALINGONF 
//FORT . SYSIN ^DD ^* 

FORTRAN  deck  of  user  supplied  subroutine  as 
specified  for  GTRESP,  KALMAN  or  PRTLOC 
/* 
//LINK. SYSIN ^DD.* 
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--INCLUDE-SYSLIB (member) 
~~ ENTRY -member 

/* 
//GO.SYSIN-DD-* 

data  deck  for  "member"  as  described 
in  Section  III. 
/* 

v. 

where  member  is  the  actual  name  of  the  subprogram 
to  be  executed.   In  this  case,  it  is  either  GTRESP,  KALMAN 
or  PRTLOC. 

For  example,  "include  sys lib (KALMAN) "  on  the  appro- 
priate card,  followed  by  "entry  KALMAN"  on  the  next  card 
would  cause  the  subprogram  called  KALMAN  to  be  run. 
3.   Mode  Three 

This  mode  of  operation  permits  the  user  to  call  more 
than  one  subprogram  while  executing  a  single  job.   Since  this 
third  option  calls  all  the  subprograms  at  the  same  time,  a 
large  amount  of  computer  memory  is  required.   The  user  must 
be  aware  that  this  increases  the  turnaround  time.  Nevertheless 
the  method  can  still  be  very  useful.   For  instance,  a  user  who 
is  not  in  a  hurry  could  utilize  this  set  up  to  obtain  the 
solution  to  several  simple  problems  which  do  not  require 
modification  of  some  parameters. 

At  this  point  the  user  is  reminded  that  great  care 
must  be  taken  to  correctly  prepare  the  control  and  data  decks. 
With  an  increased  turnaround  time,  errors  become  costly  and 
very  frustrating. 
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When  it  is  decided  to  use  Mode  Three,  the  following 
computer  cards  must  be  generated: 
//  (standard  OS  JOB  card) ,  TIME=5 
/AEXECLINCON,  REGION .  GO=350K 
,,  „   INCLUDE  ^SYSLIB  (MAIN ) 

/* 

//GO.  SYS  IN  ^DD^* 

MEMBER  1 

data  deck  for  member  1  as 

described  in  Section  III 
$ 

MEMBER  2 

data  deck  for  member  2  as 

described  in  Section  III 
$ 
/* 

where  MEMBER  1/  MEMBER  2,  etc.,  are  the  defining  names 
of  the  subprograms  to  be  executed  and  start  in  column  one. 
Note  that  again,  as  explained  in  Section  III,  the  data  deck 
pertaining  to  the  same  subprogram  can  be  arranged  either  for 
single  or  multiple  runs.   The  dollar  sign,  $,  is  a  stop  sign 
to  be  printed  in  column  one.   This  dollar  sign  card  must  appear 
after  the  last  data  deck  of  each  "member"  to  be  executed 
under  Mode  Three. 

B.   ERROR  CONDITIONS 

When  running  programs,  it  is  rather  disappointing  if 
results  do  not  come  out  as  expected.   This  in  itself  is  a  good 
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reason  to  always  verify  one  last  time  that  the  control  cards 
were  punched  correctly  and  the  data  deck  was  set  up  exactly 
as  specified.   Nonetheless,  both  neophytes  and  veterans  do 
make  mistakes  and  the  purpose  of  this  section  is  to  outline 
some  of  the  most  common  errors  and  show  how  to  identify  and 
correct  them.   The  user  must  keep  in  mind  that  the  error 
conditions  and  messages  presented  below  apply  to  the  IBM/36  0 
and  were  taken  from  [2]  which  is  the  only  up-to-date  source 
of  information  on  the  subject. 

Before  any  attempt  is  made  to  correct  an  eventual  problem, 
the  errors  must  be  'exposed1.   This  very  important  step  is 
too  often  jumped  over,  the  user  opting  to  guess  directly  what 
went  wrong.   In  order  to  save  time  and  effort,  one  should  pro- 
ceed more  logically.   The  user  should  always  check  the  linkage 
editor  and  job  scheduler  output  to  ascertain  that  the  proper 
actions  indeed  did  take  place.   Any  messages  such  as  '-Step- 
Go-Was  Not  Run  Because  of  Condition  Codes'  clearly  indicate 
what  operations  were  not  carried  out  and  direct  the  user  to 
the  problem.   Using  these  makes  it  much  easier  for  the  pro- 
grammer to  pinpoint  the  malfunction  and  take  the  appropriate 
action.   If  no  faulty  indications  appear  in  the  messages  out- 
put by  the  job  scheduler  (IEF  type  messages) ,  the  linkage 
editor  (IEW  type  messages) ,  the  program  producing  (IEY)  or 
the  object  program  (IHC)  and  the  results  obtained  are  still 
suspected  to  be  erroneous,  the  user  then  knows  he  should  devote 
his  attention  to  the  mathematics  of  the  problem  and  revise 
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the  input  data  (i.e.,  the  output  obtained  is  not  the  result 
of  a  'computer  error'). 

Some  of  the  possible  linkage  editor,  object  program  and 
program  producing  messages  are  listed  below.   These  should 
give  the  programmer  a  good  idea  of  what  to  expect  and  how  to 
proceed.   Experience  has  shown  that  even  if  only  a  minimum  of 
information  is  provided,  the  user  greatly  benefits  from  having 
these  simple  explanations  at  hand. 

1.  IEW000  (control  statement  only) 

This  message  enumerates  all  the  control  statements 
passed  to  the  linkage  editor.  INCLUDE  and  ENTRY  cards  are 
listed  for  reference.   It  is  not  an  error  message. 

2.  IEW0132  ERROR  -  SYMBOL  PRINTED  IN  AN  UNRESOLVED 
EXTERNAL  REFERENCE 

This  indicates  that  the  symbol  printed  to  the  right 
of  IEW0132  is  a  subprogram  or  subroutine  which  was  not  in  the 
specified  load  module  library  or  other  modules  passed  to  the 
linkage  editor  for  processing.   The  user  must  make  sure  the 
correct  subroutine  library  was  specified  (i.e.,  LINCON  or 
LINCONF  as  required  for  proper  mode  of  operation) ,  and  that 
the  subroutine  name  requested  was  correctly  spelled. 

3.  IEW0222  ERROR  -  CARD  PRINTED  CONTAINS  INVALID  INPUT 
FROM  OBJECT  MODULE. 

In  this  case,  either  some  control  cards  were  missing, 
thus  causing  the  editor  to  interpret  wrongly  the  cards  that 
followed,  or  some  of  the  cards  were  punched  incorrectly.   The 
deck  should  be  checked. 
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4.  IEW0342  -  LIBRARY  SPECIFIED  DOES  NOT  CONTAIN  MODULE. 
The  subprogram  or  subroutine  name  specified  on  the 

INCLUDE  control  card  was  not  found  in  the  LINCON  library. 
The  user  must  make  sure  the  INCLUDE  card  was  punched  as 
follows: 

INCLUDE  SYSLIB (member) 
where  'member1  is  the  appropriate  subprogram  name. 

5.  IHC900I  EXECUTION  TERMINATING  DUE  TO  ERROR  COUNT  FOR 
ERROR  NUMBER  217 

IHC217I  FIFOS  -  END  OF  DATA  SET  ON  UNIT  5 
Here  the  computer  stopped  executing  due  to  lack  of 
data.   At  that  instant,  the  problem  might  have  been  completely- 
solved  or  not.   It  is  advisable  not  to  take  any  chances.   Again 
the  data  deck  should  be  thoroughly  checked  to  ascertain  that 
the  cards  were  set  up  properly  and  the  data  deck  incorporated 
was  really  the  one  for  the  specified  subroutine. 

6.  IHC215  CONVERT  -  ILLEGAL  DECIMAL  CHARACTER  (decimal 
character) 

The  computer  found  the  given  decimal  character  where 
a  number  was  expected.   Either  the  data  cards  were  improperly 
set  up,  the  subprogram  name  specified  was  incorrect  or  the 
FORTRAN  format  specified  was  not  adhered  to.   Remedial  actions 
should  be  taken  accordingly. 

7.  IEY032I  NUL  PROGRAM 

This  message  indicates  that  no  exterior  subroutine 
was  provided  when  needed  and  that  the  computer  considered  all 
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the  data  expected  from  this  subroutine  to  be  zero.   Even  if 
this  situation  can  sometimes  be  used  to  advantage,  it  is  not 
recommended  here.   The  programmer  should  incorporate  all 
required  subroutines  in  his  deck.   Note  that  this  error  can 
only  occur  while  accessing  the  library  under  Mode  Two. 

8.   No  error  condition  messages  printed  out  but  incom- 
plete or  no  results  were  output  by  the  computer.   Here  many 
things  could  have  gone  wrong,  but  most  likely  one  of  the 
following  occurred: 

-  While  operating  under  Mode  Two,  the  ENTRY  card  was  not 
provided  where  required.   The  user  must  verify  the  program 
cards  for  correctness. 

-  While  operating  under  Mode  Three,  insufficient  region 
size  was  specified.   The  remedial  action  is  then  to  increase 
region  size. 

-  While  operating  under  any  of  the  three  modes  and  the 
two  conditions  described  above  were  not  the  cause,  insuffi- 
cient running  time  was  allocated  for  the  program.   If  the 
CPU  time  indicated  on  the  output  and  the  one  specified  on 
the  JOB  card  matched,  the  user  should  then  allow  more  time 
for  computation. 

-  If  none  of  the  above,  an  underflow  or  overflow  condi- 
tion may  have  occurred,  causing  the  program  to  stop.   In 
this  case  the  linkage  editor  and  job  scheduler  output  will 
indicate  a  completion  code  -  OCF.   The  user  must  verify  the 
data  cards  and  make  the  appropriate  corrections. 
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The  error  conditions  listed  above  are  obviously  not  the 
only  ones  that  can  occur,  but  they  are  the  ones  a  user  is 
most  likely  to  come  across  while  employing  the  subroutine 
library  called  LINCON. 
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III.   THE  LINEAR  CONTROL  PROGRAMS 

A.   INTRODUCTION 

The  previous  section  dealt  with  the  control  statements 
and  the  card  deck  arrangements  required  to  introduce  the 
computer  jobs  to  the  operating  system  and  tell  the  latter 
everything  it  needs  to  know  about  the  input  and  output 
requirements.   This  chapter  introduces  the  theory  necessary  to 
use  the  programs,  presents  a  precise  description  of  all  sub- 
routines and  data  cards  and  gives  detailed  examples  taken 
among  problems  that  were  solved  on  the  computer. 

1.   Outline 

The  subprograms  are  divided  into  three  classes:   the 
transfer  function  subprograms,  the  time  response  and  matrix 
manipulation  subprograms  and  the  modern  control  subprograms. 
The  first  set  allows  the  user  to  obtain  a  root  locus  starting 
from  a  block  diagram  or  signal  flow  graph  (RTLOC) ,  the 
roots  of  a  polynomial  and  their  locus  (PRTLOC) ,  the 
Bode  and  Nyquist  frequency  plots  (FRESP) ,  the  partial  frac- 
tion expansion  of  the  ratio  of  two  polynomials  (PRFEXP)  and, 
finally,  the  roots  of  any  polynomial  (ROOTS) .   The  second 
group  is  composed  of  three  subprograms  which  are  provided  for 
determining  the  rational  time  response  (RTRESP)  and  the 
graphical  time  response  (GTRESP)  of  linear  feedback  control 
systems  and  for  computing  the  determinant,  inverse,  charac- 
teristic polynomial,  eigenvalues,  state  transition  matrix  and 
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the  resolvent  matrix  (BASMAT) .   The  last  group  of  subprograms 
deals  with  optimal  control  design.   It  permits  the  user  to 
find  the  observability  index  of  a  control  system  (OBSERV) , 
to  test  for  both  controllability  and  observability  (CONOBS) , 
to  obtain  the  state  variable  feedback  given  some  performance 
criterion  (STVAR) ,  to  determine  the  complete  sensitivity 
analysis  of  the  closed-loop  system  poles  variation  as  certain 
parameters  change  (SENSIT) ,  to  design  Luenburger  observers 
(LUEN)  and  serial  compensators  (SERCOM) ,  to  minimize  a  per- 
formance index  when  some  state  variables  are  inaccessible, 
to  solve  the  Riccati  equation  to  derive  optimal  control 
parameters  and  continuous  Kalman  filters  (RICATI) ,  to  compute 
the  gains  of  discrete  Kalman  filters  (KALMAN) ,  to  evaluate 
the  feedback  control  gains  for  discrete  linear  regulator 
problems,  and,  finally,  to  decouple  multiple-input  multiple- 
output  systems  (MIMO) .   Table  I  conveniently  summarizes  the 
above . 

The  purpose  of  each  subprogram  and  a  brief  discussion 
of  the  theory  behind  it  are  given  in  the  subprograms  presentation, 
2 .   Input  Format 

The  input  format  for  each  of  the  subprograms  is  com- 
pletely described  with  their  presentation  and  must  be  referred 
to  in  each  case.   However,  since  the  same  general  input  for- 
mat is  used  for  all  the  programs,  it  is  appropriate  to  point 
out  some  of  the  similarities  and  the  conventions  adopted. 
For  instance,  to  make  it  easier  to  remember,  most  of  the 
groups  of  data  cards  have  the  same  arrangement. 
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Name 


TABLE  I  -  The  Linear  Control  Subprograms 
Purpose 


Mode  of 
Operation 


Class 


RTLOC     To  plot  the  root  of  a 
polynomial  equation 
starting  from  a  feed- 
back control  system 
block  diagram. 


One  or 
Three 


B 


PRTLOC    To  plot  the  root  locus 
of  a  characteristic 
polynomial. 


Two 


B 


FRESP     To  obtain  and  plot  the 
frequency  response  of  a 
rational  transfer 
function  over  a 
specified  range  of 
frequencies.   Both  Bode 
and  Nyquist  diagrams  can 
be  plotted. 


One  or 

Three 


A/B 


PRFEXP    To  perform  the  partial     One  or 
fraction  expansion  of  a    Three 
rational  function. 


ROOTS     To  find  the  roots  of  a     One  or 
polynomial  of  order  less    Three 
than  or  equal  to  twenty. 


BASMAT    To  compute  the  determi- 
nant, the  inverse ,  the 
characteristic  poly- 
nomial, the  eigenvalues, 
the  state  transition 
matrix,  and  the 
resolvent  matrix  from 
a  given  matrix 
A  (NxN) . 


One  or 

Three 


RTRESP    To  determine  the  rational   One  or 
time  response  of  a  system   Three 
(in  closed-form) . 
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Name 


TABLE  I 


Purpose 


(Continued) 

Mode  of 
Operation 


Class 


GTRESP     To  obtain  the  graphical 
time  response  of  a 
system  for  a  specified 
input. 


One  or 

Three 


A/B 


OBSERV    To  determine  the  One  or 

observability  index  for    Three 
a  linear  system. 


CONOBS     To  check  for  both 
observability  and 
controllability  of  a 
linear  system. 


One  or 

Three 


SENSIT  To  study  the  closed- 
loop  poles  variation 
of  a  linear  feedback 
system. 


One  or 
Three 


A/B 


STVAR     To  calculate  the 

controller  gain  and 
feedback  coefficients 
to  achieve  a  desired 
closed-loop  transfer 
function.   Also  computes 
the  plant  transfer 
function,  internal 
transfer  functions  and 
determines  H   (s)  ,  the 
equivalent  single- 
feedback  element. 


One  or 
Three 


LUEN 


To  design  Luenberger 
Observers  to  achieve  a 
desired  closed-loop 
transfer  function. 


One  or 
Three 


SERCOM    To  design  a  series 

compensator  to  achieve 
a  desired  closed-loop 
transfer  function. 


One  or 

Three 


28 


Name 


TABLE  I  (Continued) 
Purpose 


Mode  of 
Operation 


Class 


RICATI    To  solve  the  differential 
Riccati  equation  to 
determine  the  optimum 
control  gains  for  state- 
regulator  problems  and/or 
the  continuous  Kalman 
filter  gains. 


One  or 
Three 


A/B 


KALMAN    To  determine  the  discrete 
Kalman  filter  gains. 


Two 


STREG     To  evaluate  the  discrete   One  or 
feedback  gains  of  linear   Three 
regulator  problems. 


MIMO 


To  decouple  an  Nth  order 
system  with  M  inputs  and 
M  outputs  and  place  the 
closed-loop  poles  of 
each  decoupled  sub- 
system at  specified 
locations. 


One  or 

Three 
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a.  First  Data  Card 

The  purpose  of  the  first  data  card  of  any  of  the 
subprograms  is  to  identify  the  problem  for  future  reference 
and  for  output  data.   A  maximum  of  twenty  alpha-numeric 
characters  (except  $)    can  be  used,  starting  in  column  one 
(format  5A4) .   On  this  first  card,  the  user  also  normally 
defines  the  system  order   and  the  dimensions  of  the  various 
matrices  (format  12  for  each  number  to  be  entered) .   Note 
that  the  dollar  sign  $  has  been  defined  as  a  STOP  and  must 
never  be  used  as  problem  identification. 

b.  Matrices 

Matrices  are  entered  one  row  at  a  time  either  in 
their  original  form  or  transposed,  as  specified.  The  input  format 
table  presented  with  each  subprogram  indicates  the  correct  form  to 
use.   The  vectors  are  always  defined  using  lower  case  letters 
while  other  matrices  are  identified  with  capital  letters. 
The  matrix  elements  are  punched  in  ten-column  fields  (format 
8E10  or  8F10) ,  thus  a  maximum  of  eight  numbers  can  be  given 
per  card.   If  the  order  of  the  system  is  greater  than  eight, 
two  cards  are  needed  for  every  row. 

An  example  will  demonstrate  the  procedure.   Assume 
that  the  A  and  b  matrices  are: 


A  = 


3.19 

0.00 

-10.11 

2.45 

6.40 

-    0.50 

1.00 

-9.14 

6.75 

b  = 


"  1. 

0' 

0. 

0 

JL5. 

2 
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The  given  A  and  b  matrices  are  entered  using  an  8F10.3 
format  as  follows: 


.umns 

1 

11 

21 

3.19 

0.0 

-10.11 

A 

2.45 

6.4 

-    0.5 

1.0 

-9.14 

6.75 

bT 

1.0 

0.0 

15.2 

c.   Polynomials 

The  polynomial  data  can  be  entered  in  two  differ- 
ent formats  referred  to  as  P  mode  (polynomial  form)  and  F 
mode  (factored  form)  .   If  P  mode  is  selected,  the  letter  P 
(format  Al)  followed  by  the  degree  of  the  polynomial  (format 
12)  are  entered  on  one  card.   The  coefficients  of  the  polynomial 
are  placed  on  the  next  card(s)  each  in  ten  column  fields 
(format  8F10  or  8E10) .   The  polynomials  are  always  presented 
in  ascending  order,  the  constant  term  given  first  and  the 
coefficient  of  the  highest  term  assumed  to  be  unity.   In  other 
words,  the  last  coefficient  entered  will  always  be  interpreted 
as  being  1.0,  thus  can  be  entered  either  as  '1.0'  or  as  a 
blank.   Again  an  example  best  illustrates  the  principles. 

The  given  four  polynomials  are  entered  using  an 
8F10.3  format: 

(1)   Polynomials: 

(i)   2  +  4s  +  s2 

2      3     4 
(ii)   s  +  5s   +  6s   +  s 
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(iii)   1.       (highest  degree  coefficient 

of  a  zero  order  polynomial) 
(iv)    4  +  s   +s   +3s   +  s 


(2)   Computer  data  cards: 

rd 
columns 


card         1  11  21  31  41  51  61  71 


P02 

2.0         4.0  1.0 

P04 

0.0         1.0  5.0  6.0  1.0 

POO 

1.0 

P08 

4.0         0.0  1.0  0.0  1.0  0.0  3.0  0.0 

1.0 

If  it  is  desired  to  enter  the  polynomial  in 
factored  form,  then  the  F  mode  is  chosen.   This  choice  is 
indicated  by  placing  the  letter  F  (format  Al)  in  the  first 
column  followed  by  the  degree  of  the  polynomial  in  the  next 
two  (format  12) .   The  factors  are  then  entered  one  per  card, 
the  real  part  in  the  first  ten  column  field  and  the  imaginary 
part  in  the  next  ten  columns  (format  2E10  or  2F10) .   An 
unusual  convention  was  picked  to  enter  all  the  possible  factors 
The  user  must  be  careful  and  make  sure  his  notation  agrees 
with  the  following: 

(1)   The  real  part  of  the  root  is  entered  as 
positive  if  the  factor  is  in  the  left  half  plane. 
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(2)  The  real  part  of  the  root  is  entered  as 

negative  if  the  factor  is  in  the  right  half  plane. 

(3)  Only  one  of  the  complex  conjugate  roots  is 
entered  and  it  must  be  with  the  one  with  the  positive 
imaginary  part. 

(4)  If  the  polynomial  is  a  constant,  it  must 
equal  1.0  and  be  entered  in  the  P  mode,  as  shown  below. 
Examples  covering  many  possibilities  are  shown  next. 

Factored  polynomials: 

(i)     (s  +  3)  (s  -  1) 

(ii)    s(s  +  4)  (s  +  1  +  j)  (s  +  1  -  j) 

(iii)   1.0 

(iv)    (s  -  1)  (s  -  2  +  j5)  (s  -  2  -  j5)  (s  +  3)  (s  +  3) 

Computer  data  cards : 

F02 
i)     3. 

-1. 

F04 

0.0 

4.0 

1.0       1.0 


ii) 


iii) 


POO 
1.0 
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F04 

-1.0 
(iv)    -2.0      5.0 
3.0 
3.0 
One  good  way  to  remember  how  to  work  around  this 
confusing  notation  is  to  always  enter  the  real  parts  as  they 
appear  in  the  factored  polynomial  and  include  the  positive 
imaginary  part  only.   In  other  words,  one  can  analyse  any 
situation  in  the  following  manner: 

(s  +  0)   (s  +  3)   (s  -  1)   (s  +  1  +  j  2  )  (s  +  1  -  j2) 

where  the  circles  indicate  the  numbers  to  be  punched, 
d.   Multiple  Runs 

One  last  common  characteristic  of  the  input  data 
is  that  one  or  several  data  decks  pertaining  to  the  same 
subprogram  can  be  stacked  and  run  as  a  single  job.   In  other 
words,  one  complete  data  deck  is  prepared  for  each  problem 
but  the  decks  are  all  put  one  on  top  of  the  other  and  read  in 
to  the  computer  preceded  only  by  one  set  of  control  cards . 

The  user  must  realize, however, that  this  feature 
implies  more  runs  to  be  performed  in  a  single  job  and  thus 
the  time  limit  to  be  specified  on  the  JOB  control  card  must 
be  estimated  accordingly. 
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3.   Output  Format 

The  output  of  all  of  the  subprograms  is  quite  com- 
prehensible and  need  not  be  explained.   Nevertheless  confusion 
may  arise  due  to  certain  factors  that  are  commented  upon  here. 
For  the  matrices,  the  same  rules  as  for  the  input  apply; 
vectors  are  listed  out  as  transpose  matrices  and  all  other 
types  of  matrices  are  presented  one  row  at  a  time.   For 
convenience,   polynomials  are  always  output  both  in  polynomial 
and  factored  forms  no  matter  how  they  were  provided  as  input. 
As  for  the  input,  the  coefficients  appear  in  ascending  order, 
the  constant  term  first.   In  factored  form,  the  roots  are 
listed  with  their  normal  sign  convention;  the  left  half 
plane  roots  are  negative  and  those  in  the  right  half  plane 
positive. 

Hence  there  is  a  sign  inversion  between  the  input 
and  the  output  for  the  factored  case. 

B.   THE  TRANSFER  FUNCTION  SUBPROGRAMS 

This  set  helps  the  user  to  analyse  or  design  feedback 
control  systems  by  providing  a  means  of  obtaining  quickly  the 
roots  locus,  Bode  diagrams,  Nyquist  plots,  partial  fraction 
expansions  and  polynomial  roots. 

1.   Root  Locus  (RTLOC) 

This  subprogram  calculates  and  plots  the  roots  of  the 
equation 

1  +  K  G(s)   =   0 
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where  G(s)  is  a  rational  function  of  the  form 


6(8)  -      N(S) 


D(S) 


The  user  must  provide  N(s),  D(s)  and  a  range  of  value  for 
K.   Since  a  choice  of  two  ways  to  vary  K  from  minimum  to 
maximum  gain  exists,  an  option  card  is  also  required, 
a.   Input 

The  observations  and  the  table  presented  below 
should  be  sufficient  to  use  the  subprogram  which  can  be 
called  under  Mode  One  or  Mode  Three  (as  described  in  Chapter 
II): 

(1)  N(s)  can  be  input  either  in  P  form  or  F  form 

(2)  D(s)  can  be  input  either  in  P  form  or  F  form 

(3)  K  values  must  be  all  positive  or  all  negative.   If 
both  are  desired,  two  separate  runs  must  be  made.   Also,  the 
maximum  gain  value  cannot  be  zero. 

(4)  An  option  card  must  be  included  to  indicate  whether  or  not 
a  particular  region  of  the  root  locus  is  to  be  drawn  (zoom  capa- 
bility), .  A  blank  option  card  implies  no  option  is  desired.  Note 
that  selecting  a  specific  region  improves  the  accuracy  of  the  plot. 

The  last  card  tells  the  computer  to  plot  only 
the  roots  locus  in  the  rectangle  in  the  s  plane  defined  by: 


a    .   <  Re  [  s  ]  <  a 
mm  —       —  max 
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um:n  <  Im[s]  <  0) 
mm  —       —  max 


as  illustrated  in  Figure  3-1. 


amin 


Standard 


Magnified 


Fig  3-1  Magnified  and  Standard  Root  Locus 

Thus  a  standard  root  locus  plot  is  obtained  by  leaving  the 
option  card  blank,  while  a  magnified  root  locus  is  plotted 
by  punching  a  "1"  in  the  first  column  and  specifying  the 
minimum  and  maximum  values  of  a   and  u.   The  input  formats 
for  RTLOC  are  given  in  Table  II. 
b.   Output 

The  problem  identification  is  given,  followed  by 
the  numerator  and  denominator  polynomials/  both  in  factored 
and  'ascending  coefficients'  form,  and  the  minimum  and  maximum 
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Entry        Input   Description 

1  Problem  Identification 

2  letter  P  or  F  (for  P 
form  and  F  form) , 
Order  of  N(s)  (<  10) 

3  Enter  N(s)  in  format 
specified  on  previous 
card 

4  Letter  P  or  F  (for  P 
form  and  F  form) , 
Order  of  D(s)  (<  10) 

5  Enter  D(s)  in  format 
specified  on  previous 
card 

6  Minimum  value  of  gain, 
maximum  value  of  gain 

&    0) 

7  No  option  =  blank  card 

Option  ?   0 
minimum  value  of  a, 
^maximum  value  of  a, 
minimum  value  of  oi, 
maximum  value  of  oj 


Format   Columns  Used 
5A4       1-20 

Al,  12    1,  2-3 

8E10.0    1-10,  11-20, 
etc. 

Al,  12    1,  2-3 


8E10.0    1-10,  11-20, 
etc. 


8E10.0    1-10,  11-20. 


II,  9X,   1,  11-20, 
8E10.0    21-30,  31-40, 
41-50 


Table  II  -  Input  Format  Table  for  RTLOC 
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gains.   The  roots'  real  and  imaginary  parts  are  then  listed 
as  the  gain  varies  from  its  minimum  to  maximum  value. 
Finally  the  root  locus  plot  is  printed  out.   Note  that  the 
graph  produced  has  square  grids  so  that  the  true  angles  can 
be  measured. 

This  is  normally  a  class  B  program  and  time  =  2 
should  be  specified  on  the  JOB  card, 
c.   Example 

Obtain  the  root  locus  of  the  following  feedback 
control  system: 


"\ 

K(s 

2. 
s    (s 

+  1) 

+  3) 

J 

4s  +  5 

3  A  ,    2 
s     +  7s 

+  20s  +  50 

Fig  3-2   Feedback  Control  System  for  RTLOC  Test. 


The  equation  for  which  the  roots  are  to  be  found  is  then 


1  +  K 


(s  +  1)  (s*  +  4s  +  5) 


s2(s  +  3)(s3  +  7s2  +  20s +  50) 
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It  agrees  with  the  RTLOC  structure  so  one  can  proceed  further 


N(s)   =   (s  + 1)  (s  + 2  +  jl)  (s  + 2  -  jl) 


and 


D(s)   =   0  +  Os  +  150s2  +  110s3  +  41s4  +  10s5  +  s6 


Here  it  is  easier  to  enter  N(s)  in  factored  form  and  D(s) 
as  an  ascending  polynomial. 

As  a  first  guess,  the  range  of  variation  of  the 
gain  is  chosen  to  be  from  0.0  to  100.0  and  since  the  expected 
plot  is  unknown,  no  option  is  taken. 

This  completes  the  work.   The  computer  does  the 
rest  provided  the  cards  are  punched  as  follows: 
//  (standard  OS  JOB  card)  ,  TIME=2 
/AEXECsLINCON 
//LINK.SYSIN^DD^* 
~~INCLUDE~SYSLIB (RTLOC) 

/* 

//GO.SYSIN^DD^* 

RTLOC  TEST 

F03 

1. 

2.     1. 

P06 

0.0    0.0    150.    110.    41.    10. 
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0.0     100. 
(blank  card) 

/* 

The  results  appear  in  Figs.  3-3A  and  3-3B.   Note 
that  the  user  should  mark  the  open-loop  poles  and  zeroes  for 
easier  interpretation. 

2.   Root   Locus  (PRTLOC) 

As  the  name  indicates,  this  subprogram  is  a  modified 
version  of  RTLOC.   It  calculates  the  roots  of  a  polynomial 
and  plots  them.   The  method  to  input  the  data  differs  slightly 
but  the  ultimate  goal  remains  the  same, 
a.   Input 

This  subprogram  can  only  be  used  under  Mode  Two 
of  operation.   The  coefficients  of  the  polynomial  must  be 
entered  using  a  simple  subroutine  called  RPOL(CG)  which  must 
be  typed  as  follows: 

SUBROUTINE  RPOL(C,G) 

DIMENSION  C(20) 

C(l)  =  fnct  (G) 

C(2)  =  fnct  (G) 


C(n+1)  =  1.0 
RETURN 
END 
where  n  =  order  of  the  eauation 
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PUCT    LOCUS    PPOGBAM 

PR03LEM    IDENTIFICATION  -   RUCC   TEST 

NUMERATOR    COEFFICIENTS    IN   ASCENDING   POWERS  OP  S 

5.000  9.000  5.0CC  1.000 

OPEN-LOOP  ZEROES 

REAL    PART        IHAG.    PART 
-2.OC0E    03  -l.OOOE    00 
-2.000E    00       l.OOOE    00 
-l.OOOE    00      0.0 

DENOMINATOR.    COEFFICIENTS    IN    ASCENOING    POWERS    OF    S 

0.0  0.0  150.000        110.000  41.000  10.000  1.000 

GPef«-L0OP   POLES 

REAL    PART       1MAG.     PART 
-l.OOOE    00    -3.000E    00 
-l.OOOE    00      3.000E    00 
-5.0005    00      0.0 
-3.000E    00      0.0 

0.0  0.0 

0.0  0.0 

HIM.    GAIN   -        0.0  MAX.    GAIN   -         l.OOE    02 

»»•»•«»•»•■*««•«»«».»«•««•••«»•»«■*«**•*•#*** 

1  GAIN    ■      0.0 

ROOTS    APE 
REAL    PART       IM&G.    PART 

-l.OOOE    00   -3.000E    00 
-l.OOOE    00       3.000E    00 
-5.000E    00      0.0 
-3.000E    00      0.0 

0.0  0.0 

0.0  0.0 

Z  GAIN   *      5.750E-02 

ROOTS    APE 
REAL    PART       1MAG.    PART 

-9.985E-01    -3.J00E    00 
-9.V85E-01       3.00CE    00 
-5.002E    00       0.0 
-2.9996    00      0.0 
-1.023E-03    -4.377E-02 
-1. 0236-03       4.377E-02 

3  GAIN    ■      1.236E-01 

POOTS    APE 
REAL    PART        1«AG.    PART 

-2.99UE    00      0.0 
-9.969F-01    -3.001?    00 
-9.9696-01       3.U01E    00 
-5.00<»E    00       0.0 
-2.199F-03    -6.416E-02 
-2.199E-03       6.M6E-02 

*  GAIN    •       1.9*7E-0l 


19  Sl!f     =       7.726E    CI 

SCOTS    iPE 
PEAL    P^T        I  "AT.  .     PA3T 


-6.5J9E 

00       CO 

«.«»2:jf- 

-01    -3. SoU    TC 

<t.<.25?- 

-01       3.^1=    GC 

•2.24*~ 

:o     c.o 

-1 .0?V£ 

OJ    -7.53iE-Jl 

-1.02"»E 

J3       7.53l*-01 

<.C 

«IM   =       -t.E<>CE    o: 

POTTS     l'r 

REAL    PURT  I«iC..     PART 

5.S7aF-0l  -4.1C3C    CC 

5.57eE-01  *-!C8E    OC 

-6.6S9E    Oj  CO 

■J.JUc    00  CO 

-1.1036    OJ  -7.277E-01 

-1.1036    00  7.2/7E-01 


Figure  3-3A  Root  Locus  Test  -  Numerical  Output 
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C  (1)  /  ...C(n+1)    =   coefficients  of  the  polynomial,  in  ascending 

order.   Note  that  the  coefficient  of  the 
highest  order  term  C(n+1)  must  be  1.0  and 
need  not  be  entered. 

fnct  (G)   =   defining  coefficient  equation  in  terms  of 
G,  the  gain.   The  function  could  very  well 
be  a  constant  only. 

The  remaining  data,  i.e.,  the  problem  identifica- 
tion, range  of  gain  values  and  option, are  entered  as  follows: 


ENTRY       Input  Description      Format      Columns  Used 

1  Problem  identification,   5A4 ,        1-20 
Order  of  the  polynomial,  12  21  -  22 

2  minimum  value  of  gain,    8E10.0      1-10,  11-20 

maximum  value  of  gain 
&    0) 

3  (no  option  =  blank  card}   II,  9x,      1,  11-20,  21-30,  31-40 

option  ?   0,  8E10.0      41-50 

minimum  value  of  a, 
maximum  value  of  a, 
minimum  value  of  oj, 
maximum  value  of  w. 

Table  III  -  Input  Format  Table  for  PRTLOC 

Here  again,  the  gain  values  must  be  either  all 
positive  or  all  negative  and  the  maximum  gain  cannot  equal 
zero. 


44 


The  first  card,  in  addition  to  the  usual  problem 
identification  must  contain  the  nolynomial  order  in  columns 
21-22. 

The  last  card  is  used  to  indicate  whether  or 
not  a  portion  only  of  the  root  locus  is  to  be  refined  and 
plotted.   If  the  option  is  selected,  a  number  greater  than 
zero  is  punched  in  the  first  column,  followed  in  columns 
11-50  by  the  parameters  defining  the  rectangular  portion  to 
be  blown  up  (see  example) .   If  this  option  is  not  desired, 
the  card  is  left  blank.   Note  that  this  version  permits  us 
to  find  the  roots  of  any  characteristic  equation  with  a  single 
varying  parameter  G. 

b.  Output 

The  problem  identification  and  the  minimum  and 
the  maximum  gain  are  first  listed  out  for  future  reference. 
Next,  the  root  values  are  given  as  the  gain  varies  and  the 
root  locus  plotted.   The  execution  time  to  be  included  on  the 
JOB  card  should  be  "time  =2". 

c.  Example 

While  trying  to  solve  problem  7.26  in  Shinners 
[3] ,  one  comes  across  the  following  characteristic  equation 
for  part  of  the  system: 


s4  +  9.15s3  +  (1.32  +  20K2)s2  +  (26K2~.15)s  +  C6K2  +  0.675)  =  0 


At  this  point  the  root  locus  is  desired  to  determine  what 
value  of  K^  is  required  to  satisfy  some  criterion.   Since 
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the  characteristic  equation  is  specified  explicitly,  PRTLOC 
is  selected. 

First  the  coefficients  are  sorted  out  and  written 
as  functions  of   G  where  G  is  equal  to  K~ . 

s**0  coefficient  :   C(l)  =  0.675  +  6 . *G 
s**l  coefficient  :   C(2)  =  -0.15  +  26. *G 
s**2  coefficient  :   C(3)  =  1.32  +  20. *G 
s**3  coefficient:    C(4)  =  9.15 
Note  that  the  coefficient  of  the  highest  order  term  is  always 
taken  as  1.0  and  need  not  be  included.   The  above  data  is  to 
be  entered  by  writing  the  subroutine  RPOL(C,G). 

The  order  of  the  equation  is  04.   The  range  of 
gain  values  to  be  investigated  is  from  0.0  to  20.0  and  since 
no  refined  plot  is  desired  at  this  point  the  last  card  is 
a  blank  card. 

The  following  cards  then  constitute  the  entire 
deck  to  be  input  to  the  computer: 
//  (standard  OS  JOB  card)  /TIME:a,2 
/AEXECLINCONF 
//FORT . SYSIN  JDD „* 

SUBROUTINE  RPOL(C,G) 
DIMENSION  C(20) 
C(1)=0. 675+6. 0*G 
C(2)=-0. 15+26. 0*G 
C(3)=l. 32+20. *G 
C(4)=9.15 
RETURN 
END 
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/* 

//LINK . SYS IN* DD-  * 

-  *  INCLUDE- SYSLIB (PRTLOC ) 

~- ENTRY- PRTLOC 

/* 

//GO.SYSYN~DD~* 
PRTLOC  TEST  ONE     04 
0.0     20.0 
(blank  card) 

/* 

The  results  obtained  with  this  first  run  as  are  shown  in  Figs. 
3-4A  and  3-4B.   However  they  do  not  permit  us  to  evaluate  the 
gain  precisely  enough  and  a  second  run  is  made,  this  time 
using  the  option.   The  rectangular  portion  where  magnification 
is  desired  is  defined  by: 


a  .    =  -5. 
mm 


a     =5. 
max 


0)      =   -1. 
nun 


a)     =   5 . 

max 


Note  that  this  option  not  only  concerns  the  plotting  but  also 
produces  a  larger  number  of  gain  values.   Thus,  in  order  not 
to  have  too  many  values  listed  out  unnecessarily,  it  is  good 
practice  to  re-specify  the  range.   It  was  decided  to  change 
it  to  vary  from  0.0  to  10.0. 
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P'lOT    IUCUS     PK0G54H 

PRC8LE"    IOE  NTIMCATIGh   ~    PBTLCC    TEST    ONE 

HIM.    GAIN    «  0.0  M4X.     GAIN    ■ 


2.00E   01 


1  GAIN    «      O.C 

RCOTS    APt 
R6*L    PART        I^AG.    PART 

-9.001E    OJ       0.0 
1.7b2fc-Ol    -3.<»55F-01 
1.752E-01       3.*55E-Ol 

-4.9975-01       0.0 

2  GAIN    «      5.750E-02 

PPOTS    APF 
RFAL    PART        MAG.    PART 

-8.88RE    00  0.0 

1.072F-01  -4.767E-01 

1.0726-01  <.. 7176-01 

-4.768E-01  0.0 

3  GAIN    *       1.236E-01 

ROOTS    AR= 
REAL    PART       I«AG.    FART 

-b.7556    00  0.0 

2.86Hz-02  -5.972F-01 

2.8C86-02  5.972E-01 

-4.527E-01  0.0 

*  GAIN    =       1.99  7E-01 

RQITS    AR= 
PEAL    PART        IMAG.     PART 

-8.597F    OJ  0.0 

-ft.1936-02  -7.10CE-0I 

-6. 1936-02  7.100F-01 

-4.28*6-01  0.0 


;ain 


2.B71E-01 


ROOTS    APc 
PEAL    PART       I*AG.    PART 

-8.4106     J1  0.0 

-1.66tC-01  -8.201E-01 

•1.666F-01  8.201E-01 

•4.C72E-01  0.0 


GAIN 


3.B77E-01 


ROOTS    Ai>c 
REAL    PAST        I^ac.    PART 

•8.184E    03       0.0 
•2.4fldc-0l    -9.278F-01 
"2.H886-01       9.278c-0l 
■3.88*F-ul        0.0 


7  GAIN    « 

RCTTS    *PE 
REAL    PART       I*A< 


5.033E-01 

.    PART 


■7.910C    00  0.0 

■4.3376-01  -1.032E    00 

■4.337E-01  1.032c    CO 

■3.723E-01  0.0 
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GAIN    ■       l.fc3CE    01 


P0C1TS    APC 
REAL    PA*T        ISAG.    PART 

-3.910E    00    -1.73fcF    01 
-3.910L    00       1.736E    CI 
-1.T2UE     CO       0.0 
-3.J26E-C1       0.0 
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GAIN    s        I. 66  IE    01 


FOOTS    APE 
REAL    HAKT       IMAG.    FART 

-l.C2«E    00       C.O 
-3.912E    00    -1.375F    01 
-3.912E    00       1.375E    01 
-3.023E-01       0.0 


Figure    3-4A      PRTLOC   Test  One   -   Numerical   Output 
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Since  the  characteristic  equation  did  not  change, 
only  the  data  deck  is  to  be  modified.   These  last  three 
cards  are  given  below. 

PRTLOCTEST  TWO   04 

0.0     10.0 

1       -5.0       5.0      -1.0      5.0 

This  magnified  portion  of  the  root  locus  is 
presented  in  Fig.  3-5A  and  3-5B 

3.   Frequency  Response  (FRESP) 

This  subprogram  determines  the  frequency  response  of 
a  rational  transfer  function 


G(s)   =   KN(S) 


D(s) 


and  plots  the  response  in  the  form  of  a  Bode  or/and  Nyquist 
diagram,  as  specified, 
a.   Input 

The  problem  identification,  the  gain  and  the  two 
polynomials  N(s)  and  D(s)  are  entered  followed  by  the  minimum 
and  the  maximum  radian  frequency  values,  the  number  of  fre- 
quency values  to  be  used  (smaller  or  equal  to  500) ,  the  inter- 
polation and  discrete  value  options,  the  Bode  plots  and  the 
Nyquist  diagrams  options  and,  only  if  required,  the  discrete 
frequency  values. 

It  might  look  complex  at  first,  but  the  subprogram 
is  very  simple  to  use  and  the  results  obtained  are  quite  good. 
The  routine  is  accessed  under  Mode  One  or  Mode  Three.   The 
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ROCT  LOCUS  PROGRAM 

PROBLEM  I0ENTIFIC4TICN  -  FRTLCC  TEST  TWO 

••**«»*»«*»«»»*»•«*»»»«»««»♦«»*»»*«•«**»*«»*« 

MIN.  CAIN  »    0.0  MAX.  RAIN  «    I  .00E  01 

OPTION    HAS    BEEN    TAKEN 

SIGMA    KIN    •      -5. OOF    00  SIGMA    VAX    »         5.00?    00 

OMEGA    Ml*    »      -l.OCE    00  OKEGA    MAX    »        5.00E   00 

1  GAIN    ■       0.0 

SCOTS    ARE 
REAL    PART       IVAG.     PART 

-9.001E    00       0.0 

1.752E-01    -3.<»55E-0l 

1.752E-01       3.455F-01 
-4.S97E-01       0.0 

2  GAIN   »       2.080E-02 

ROOTS    APE 
REAL    PART       IMAG.    PART 

-8.960E    00       0.0 

1.5075-01    -3.9-J7F-01 

1.507F-31       3.W87E-01 
T*.913fc-01       0.0 

3  GAIN    a      *.2<,3E-02 

RCOTS  APE 
R=AL  PART   IMAG.  PART 

-8.917E  13  0.0 

I.251E-01  -4.W6F-01 

l.«<5l?-0l  4.<»7oE-01 

-*.Ri7E-01  0.0 

*       GAIN  *   6.493E-02 

PO'JTS  A«c 
REAL  PART   I*'AG.  PART 

-8.8/3*  OJ   0.0 
9.3*36-02  -*.93*E-0l 
9.«*?E-02   *.93*E-01 

-*.7*oe-oi  0.0 

5  GAIN  »   8.8^3E-02 

PCQTS    AFF 
REAL    PART       IMAG.    PART 

-t».82*F    00      0.0 

7.0h5F-02    -5.371E-01 

7.0656-02       5.371E-01 
-*.652E-0l       0.0 

6  GAIN    »       1.I27E-01 

ROOTS    ARE 
REAL    PART        IMAG.    PART 

-8.777e    OJ      CO 

*.172F-02    -5.792E-01 

*.172e-32       5.792F-01 
-4.565E-01       0.0 


7o  GAIN    ■       J.331E    CC 

ROOTS    APE 
PEAL    PART        IMAG.    F»HT 

-J.697E    00   -1.272E    01 
-3.6V7F    0^       1.272E    01 
-  1 .  u  5  I F    .JO       0  .  O 
-3.0*6fc-0l       0.0 

77  GAIN    =       9.725E    OC 

PO-)TS    AKE 
k^AL    PA*T       IMAo.    PART 

-i.n^se    JJ    -1.3C?.F    31 
-3.oSi-.i-    JO       1.303F    01 
-l.0*8E    00       0.0 
-3.0**6-01       0.0 

Figure    3-5A     PRTLOC  Test  Two   -  Numerical  Output 
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input  format  table  and  the  example  that  follows  demonstrate 
the  procedure  to  be  used. 


Entry 

Input  Description 

Format 

Columns  Used 

1 

Problem  identification 

5A4 

1-10 

2 

The  gain  K 

8E10.0 

1-10 

3 

letter  P  or  F  (for  P  form 
or  F  form) ,  order  of 
N(s)  <_   10 

A1,I2 

1,  2-3 

4 

Enter  N(s)  in  format 

8E10.0 

1-10,  11-20, 

specified  on  the  orevious 

etc. 

3 


card 

letter  P  or  F  (for  P  form 
or  F  form) ,  order  of 
D(s)  <  10 

enter  D(s)  in  format 
specified  on  the 
previous  card 

minimum  radian  frequency  (^0) , 
maximum  radian  frequency, 
number  of  frequency  values 
to  be  used  (£500) 

option  I:   logarithmic 

interpolation 
=  000 
discrete  values 

supplied  =  001 
linear  interpolation  =  002 

option  B:   Bode  plot  =  000 

no  Bode  plot  =  001 

option  N:   Nyquist  plot  =  000 
no  Nyquist  plot 
=  001 


(if  and   discrete  frequency  values 
only  if 
optioni 
=  001 


Al,  12 


13 


13 


13 


8E10.0 


1,  2-3 


8E10.0 

1-10,  11-20, 

etc. 

2E10.0 

1-10, 

11-20, 

13 

21-23, 

24-26, 


27-29 


30-32 


1-10,  11-20, 
etc. 


Table  IV  -  Input  Format  Table  for  FRESP 
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Here  the  option  card  is  a  bit  complex,  but  it 
provides  great  flexibility.   The  following  ideas  should  help 
clarify  the  concept: 

(1)  The  first  three  entries  specify  the  range  and  the 

number  of  data  points  for  the  Bode  and/or  Nyquist  plot.   One 

must  recall  that  the  Bode  magnitude  plot  is  log-log;  the  Bode 

phase  plot  is  log-linear  (angles  in  degree)  while  the  Nyquist 

is  a  polar  plot.   Thus,  minimum  and  maximum  radian  frequency 

values  should  be  carefully  chosen.   For  example,  to  .   =0.01 

mm 

and  to    =  100  could  be  a  good  choice  in  a  given  problem 
while  being  absurd  for  another  one. 

(2)  Option  I  specifies  the  type  of  interpolation  to  be  used 
to  generate  the  values  between  the  minimum  and  maximum  frequency. 

If  Option  I  =  000,  logarithmic  interpolation  is  used  to 

select  the  frequency  value.  Either  plot 
can  be  obtained  while  specifying  this  option, 

If  Option  I  =  001,  the  user  must  enter  on  the  following 

cards  the  frequency  values  for  which 
he  wants  G(jco)  to  be  evaluated.   The 
number  of  frequency  values  must 
again  be  less  or  equal  to  500.   No 
plot  can  be  obtained  when  this  option 
is  selected,  only  tabular  outputs. 

If  Option  I  =  002,  linear  interpolation  is  used  to  select 

the  frequency  values  for  which  G(jco) 
is  to  be  computed.   Only  the  Nyquist 
plot  can  be  obtained  when  this  option 
is  used. 
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(3)  Option  B  indicates  whether  or  not  Bode  diagrams  are 
to  be  drawn. 

If  Option  B  =  000,  Bode  plots  will  be  output 

If  Option  B  =  001,  Bode  plots  will  not  be  output' 

(4)  Similarly,  option  N  is  used  to  specify  whether  a 
Nyquist  plot  is  desired  or  not. 

If  option  N  =  000,  it  is  desired 

If  option  N  =  001,  it  is  not  desired. 

(5)  The  options  card  is  not  followed  by  any  card  except 
when  option  I  is  equal  to  001.   If  this  is  the  case,  the 
frequency  values  must  be  entered  using  an  8E10.0  format. 
Note  that  an  option  card  containing  only  the  minimum  and  the 
maximum  frequency  values  and  the  number  of  points  to  be 
evaluated  indicates  that  both  Bode  and  Nyquist  plot  are 
desired. 

b.   Output 

The  problem  identification,  the  value  of  the  gain, 
the  coefficients  of  the  polynomials  N(s)  and  D(s)  as  well  as 
their  roots  are  listed  for  reference.   Next,  the  radian  fre- 
quency, the  real  and  imaginary  part  of  G(joj),  the  magnitude 
|  G  (  joj)  |,  the  magnitude  in  db,  the  phase  in  radians  and  the 
phase  in  degrees  are  printed  out  in  tabular  form  for  the 
indicated  number  of  frequency  values  (smaller  or  equal  to 
500)  . 

If  option  B  =  000  has  been  selected,  the  magnitude 
and  phase  Bode  diagrams  are  given.  Note  that  the  phase  angles 
are  always  normalized  to  lie  between  -180°  and  +180°. 
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If  option  N  has  been  requested,  the  Nyquist 
diagram  is  plotted  with  the  points  linearly,  or  logarithmically, 
spaced  out. 

Normally  the  CPU  time  required  to  run  the  program 

is  less  than  20  seconds  (class  A) . 

c.   Example  One 

The  Bode  plot  for  the  loop  transfer  function  is  to 
be  obtained  for  the  following  system: 


^9 


60(s  + 50) 
s(s+  10) 


s  +  20 


Fig.  3-6   Compensated  Control  System  for  FRESP  Test 


The  first  step  is  to  define  G(s).   Here  it  is  simply 


G(s)   =   K 


N(s) 
D(s) 


=   60  [ 


(s  +  50) 


s(s  +  10)  (s  +  20) 


] 


The  gain  is  60  and  since  both  N(s)  and  D(s)  are  already 
factored,  they  can  best  be  entered  using  F  form.   The  minimum 
and  maximum  frequencies  are  arbitrarily  chosen  to  be  0.1  and 
100,  respectively.   The  number  of  frequency  values  for  which 
G(jjjj)  is  to  be  evaluated  is  50.   Since  a  Bode  diagram  is 
desired,  option  I  must  equal  000  (logarithmic  interpolation) 
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and  option  B  also  equals  000.   In  this  case  a  Nyquist  plot 
is  not  desired  and  option  N  is  entered  as  001. 

The  control  cards  and  data  deck  to  run  the  sub- 
program are  then: 
//  (standard  OS  JOB  card) 
//.EXECsLINCON 
//LINK . SYS IN  ^DD  ** 
„  INCLUDE ^SYSLIBCFRESP) 

/* 

//GO. SYS IN  DD  * 

FRESP  TEST  ONE 

60. 

F01 

50. 

F03 

0.0 

10.0 

20.0 

0.1     100.     050000000001 


/ 


* 


The  Bode  diagrams  are  shown  in  Fig.  3-7  (A-C) .  Note 
that  the  phase  versus  frequency  diagram  presented  is  not  in 
error  but  simply  due  to  the  fact  that  the  angle  values  are 
normalized  to  be  within  -180  and  +180  degrees.   This  is 
useful  since  it  permits  one  to  rapidly  determine  where  the 
-180° crossing  occurs. 
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d.   Example  Two 

The  problem  to  be  solved  now  requires  that  only 
a  Nyquist  plot  be  obtained  for  the  following  open-loop 
transfer  function  of  a  compensated  system: 


n,„,   _         Cs  +0.7)  (s  +  0.15)20 
<j  vS;   — 


(s  +  7)  (s  +  0.015)  (s  +1)  (s  +  2)s 


The  frequency  range  is  selected  to  be  from  0.2  to  10.0  and 

calculations  are  to  be  carried  out  for  twenty-five  frequency 

values  using  logarithmic  interpolation.   The  computer  deck  is 

then: 

//  (standard  OS  JOB  card) 

/A  EXEC,,  LINCON 

//LINK. SYS IN ADDA* 

„ ^ INCLUDE „SYSLIB(FRESP) 

/* 

//GO.SYSIN^DD,,* 

FRESP  TEST  TWO 

20.0 

F02 

-.15 

0.7 

F05 

0.0 

1.0 

2.0 

0.015 
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025000001000 


7. 

0.2     10.0 

/* 

Results  are  shown  in  Figs.  3-8A  and  3-8B. 

4.   Partial  Fraction  Expansion  (PRFEXP) 

This  subprogram  performs  the  partial  fraction 

expansion  of  the  ratio  of  two  polynomials  of  the  form 


G(s)   =   K 


N(s) 
D(s) 


,  (degree  of  N(s)  < 


degree  of  D (s) ) 
a.   Input 

The  problem  identification,  the  gain  value  K  and 
the  polynomials  N(s)  and  D(s)  are  entered  according  to  the 
following  input  format  table: 


ENTRY   Input  Description 

1  Problem  identification 

2  gain  value  K 

3  letter  P  or  F  (for  P  form 
and  F  form) ,  order  of 
N(s)  <_   10 

4  enter  N(s)  in  form  specified 
on  previous  card 

5  letter  P  or  F  (for  P  form 
and  F  form) ,  order  of 
D(s)  <  10 

6  enter  D(s)  in  form  specified 
on  previous  card 


Format 

Columns  Used 

5A4 

1-20 

8F10.3 

1-10 

Al,  12 

1,  2-3 

8F10.0 


1-10,  10-11, 
etc. 


Al,  12    1,  2-3 


8F10.0    1-10,  10-11, 
etc. 


Table  V  -  Input  Format  Table  for  PRFEXP 
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D(s)  must  not  have  multiple  complex  roots  for  the  subprogram 
to  work.   If  it  does,  a  message  is  printed  and  the  problem 
terminates  at  that  point.   Note  that  D(s)  may  have  multiple 
real  roots  though. 

b.  Output 

The  problem  identification  and  the  gain  value  are 
listed  followed  by  the  numerator  and  the  denominator  in  both 
factored  and  unfactored  forms.   For  the  denominator, 
each  root  value  is  listed  once  only  with  its  multiplicity 
indicated.   Note  that  roots  are  considered  equal  if  their  real 
and  imaginary  parts  do  not  differ  by  more  than  0.005.   The 
example  presented  in  c  .  illustrates  how  to  deal  with  multi- 
plicity of  roots  in  the  interpretation  of  the  results.   The 
residue  matrix  real  and  imaginary  parts  is  then  given. 

This  subprogram  can  be  run  as  a  class  A  job. 

c.  Example 

The  partial  fraction  expansions  of  the  following 
rational  functions  are  to  be  performed: 


,  ,       20 

(a)       


656  +  752s  +  264s2  +  28s3  +  s4 


(b)       2  +  S 


2  +  4s  +  3s  +  s 


N(s)  and  D(s)  are  entered  using  both  the  F  and  the  P  forms  and 
the  partial  fraction  expansions  of  the  two  polynomial  ratios  can 
easily  be  obtained  in  a  single  run  by  stacking  the  data  deck. 
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The  computer  cards  are: 
//   (standard  OS  JOB  card) 
//  EXECJLINCON 
//LINK. SYS IN ^DD^* 
^INCLUDE  ^SYSLIB  (PRFEXP) 

/* 

//GO.SYSINJDD^* 

PARTIAL  FRACTION  A 

20. 

POO 

1.0 

P04 

656.      752.      264.      28.      1.0 

PARTIAL  FRACTION  B 

1.0 

F01 

2.0 

P03 

2.0       4.0       3.0       1.0 

/* 

and  the  solutions  are  presented  in  Figs.  3-9A  and  3-9B. 

Interpretation  of  these  results  gives: 


,,*   n   ..  ,  .    ..    .     .0139  +  j.0124    .0139  -j.0124 
(1)   Partial  fraction  A  =    s+12+j4.47   +    S+12-J4.47 


-.0278    .1667 


s+2     ,  , nN  2 
(s+2) 
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PARTIAL    FRACTION    EXPANSION 

PRC5L5*    IDcKTIFICATION   -         PARTIAL   FRACTION   A 

NUMFRATGR   GAIN    *       2.0C0E    CI 

NUMERATOR   CCcFF.    -    IN   ASCENCING    POWCRS 

1.033E    03 
DENOMINATOR   CCEFF.    -    IN   ASCFSCING    POWERS 

6.560E    02    7.520£    02    2.640fe    02    2.800E    01    l.OOCE    00 

«»■«"»»*««  **«**.«*  ******************* *******9 

DENOMINATOR.    PCOTS 

REiL    PART  IM/G.    PART      MULTIPLICITY 

-1.1999992l-  01-4.*72159't1£    OC  1 

-1. 1999992b  01    ^.A72159<.!:    00  1 

-2.0011177c  00   0.0  2 

PESIOUc    MATRIX    -    Rt.iL    PART 

1.3892S05C-02 
1.3392505a-O2 
-2.7785011--02    1 .6fc49762F-01 

PcSICUS    MATRIX    -    IHAG.    PART 

1.2*23633<=  -02 
~1.2«23633£-02 

O.C  3.0 


Figure  3-9A  Partial  Fraction  Expansion  A 


PARTIAL     FRACTION    *=XPANSIGN 

PR03LE*    IOENTIFICATICN   -         PARTIAL    FRACTION    B 

NUMERATOR    GAIN    =       1 .OOOE    00 

NUMERATOR    CGEFr.    -    IN    ASCENDING    POWERS 

2.000E    00    l.OOJ*    00 

NUMERATOR   RC3TS 

R=AL    PART  IMAG.     FART 

-2 .00000  GO*    00    0.0 

DENOMINATOR    CCEFF.    -    IN   ASCENOING    POWERS 

2.000E    00    4.000F    00    3.00CE    00    1.0006    00 

CENCMINATOA    RGCTS 

RriL    PART  IMAO.    PAPT       MULTIPLICITY 

-1.0j03)«J>:    00-l.JOCv010E    00  1 

-l.OOOOOOOH    CO    UCCCOOlOt    OC  1 

-9.999999V--01    0.0  1 

RESIDUE    MATRIX    -    REAL    PAFT 

-*.99999C5=-01 

-«.999S9J3C-C1 

9.99S93C9E-01 

RESIDUE  MATRIX  -  IKAG.  PART 

4.9999923^-01 
-*.9999923fc-01 
0.0 

Figure  3-9B   Partial  Fraction  Expansion  B 


67 


Note  that  the  second  residue  appearing  in  the  output  belongs 

2 

to  (s+2)  .   If  a  multiplicity  three  had  been  the  case,  a 

third  residue  would  have  been  the  numerator  of  a  cubic. 

(2)   Partial  fraction  B  =  ~,5t^5  +  ",57:i:5  +  -L_ 

s+1+3      s+l-j     s+1 

5.   Roots  of  a  Polynomial  (Roots) 

This  subprogram  finds  the  roots  of  a  polynomial  of 
degree  less  or  equal  to  twenty. 

a.   Input 

The  first  data  card  contains  the  problem  identi- 
fication in  the  first  twenty  columns  and  the  polynomial  order 
in  columns  21-22  (format  12).   On  the  next  card(s)  the  poly- 
nomial coefficients  starting  with  the  lowest  order  term  are 
entered  (format  8E10.0).   These  two  entries  are  repeated  for 
every  polynomial  to  be  factored.   Note  that  the  highest  order 
term  coefficient  must  be  unity. 


Entry    Input   Description 

1  Problem  identification, 
polynomial  order 

2  polynomial  coefficients 
in  ascending  order 
(highest  order  term 
coefficient  being  one) 


Format 


Columns  Used 


5A4 
12 

1-20 
21-22 

8E10.0 

1-10,  11-20, 
21-30,  etc. 
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b.  Output 

The  problem  identification  and  the  polynomial 
coefficients  are  listed  for  reference.   The  roots'  real  and 
imaginary  parts  are  then  printed. 

c.  Example 

The  following  polynomials  are  to  be  factored: 

s3  +  l 

4  3       2 

s   +  s   +  12s   -  5s  +  1 

5  2 

s   +  s   +  s 

The  computer  cards  are  then: 

//(standard  OS  JOB  card) 

/AEXEC^LINCON 

//LINK.SYSIN^DD,,* 

^    .       INCLUDE ..SYSLIB  (ROOTS) 

/* 

//GO.SYSIN^DD,.* 

Roots  test  one    03 

1.0     0.0     0.0     1.0 

Roots  test  two    04 

1.0     -5.0    12.0    1.0     1.0 

Roots  test  three 

0.0     1.0     1.0     0.0     0.0     1.0 

/* 

The  result  is  shown  in  Figure  3-10. 

C.   TIME  RESPONSE  AND  MATRIX  MANIPULATION  SUBPROGRAMS 

These  three  subprograms  permit  a  user  to  analyze  linear 
control  systems  for  rational  and  graphical  time  response  and 
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also  provide  matrix  manipulation  to  easily  solve  for  deter- 
minants, inverses,  state  transition  and  resolvent  matrices, 
eigenvalues  and  characteristic  polynomials. 

The  control  system  must  be  linear  and  represented  in  state 
variable  form  as  [1] 

x(t)=A  x(t)  +  b  uCt) 
u(t)=K[r(t)  -  kTx(t)] 
y(t)=c  x(t) 


where  u  (t)  ,  r(t)  and  K  are  scalar  and  the  system  order  is  less 
or  equal  to  ten.  In  block  diagram  form,  the  matrix  system  can 
be  represented  as 

x(t)  y(t) 


Fig  3-11   Linear  Control  System  Block  Diagram. 


The  diagram  readily  shows  all  the  elements  to  be  provided  for 

the  study  of  any  given  system.   For  instance  one  can  view  that 

T 
setting  k  =  0  gives  an  open-loop  system  and  that  unforced  sys- 
tem analysis  can  be  done  by  simply  letting  r(t)  =  0. 
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1.   Basic  Matrix  Manipulation  (BASMAT) 

This  subprogram  is  used  to  perform  various  calculations 
associated  with  the  plant  matrix  A  of  a  given  linear  control 
system.   It  is  a  class  A  job  and  must  be  run  under  Mode  One 
or  Mode  Three. 

a.   Input 

The  problem  identification  and  the  dimension  of  A 
are  given  on  the  first  card.   Next  the  A  matrix  is  entered, 
one  row  at  a  time  using  an  8E10.5  format.   Thus,  if  the  dimen- 
sion of  the  matrix  is  eight  or  less,  one  row  per  card.   Other- 
wise the  9th  and/or  10th  elements  appear  on  a  second  card  and 
the  rule  becomes  one  row  per  two  cards.   The  last  card  indi- 
cates what  matrix  operations  are  to  be  performed.   The  key  to 
obtain  the  proper  results  is  explained  after  the  input  format 
table. 

Entry    Input  Description  Format      Columns  Used 


\-Z^v  '• 


1     Problem  identification  5A4,I2      1,  2-3 

dimension  of  A(N  <_  10) 

A(NxN)  matrix  8E10.5       1-10 , 11-20 , etc 
(one  row  per  card 

for  N  <_  8;  one  row  per  two     8E10.5      1-10 ,11-20 , etc 
cards  for  N  >  8) 

option  det   0,  determinant       II  1, 

desired 

1,  determinant       II 
not  desired 

option  inv   0,  inverse  desired   II  2, 

1,  inverse  not 
desired 
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Entry    Input  Description  Format  Columns  Used 

option  phi(s)     0,  <|>(s)  desired   II   3, 

lf  <J>  (s)  not 

desired 

option  C.E.       0,  characteristic  II    4, 

polynomial 
desired 

1,  characteristic 
polynomial 
not  desired 

option  eigen     0,  eigenvalues     II    5, 

desired 

1,  eigenvalues 
not  desired 

option  phi(t)     0,  <j>(t)  desired    II    6. 

1,  <j>(t)  not 

desired 

Table  VI  -  Input  Format  Table  for  BASMAT 

Thus,  a  zero  indicates  that  the  computation  is  desired  while 
a  number  from  1  to  9  informs  that  the  listed  operation  is  not 
to  be  performed.  Six  zeros  or  a  blank  card  would  result  in  an 
output  that  contains  the  A  matrix  determinant,  inverse, resolvent, 
characteristic  polynomial,  eigenvalues  and  state  transition  matrix, 
b.   Output 

The  problem  identification  and  the  A  matrix  are 
listed  first.   Then  the  result  of  each  operation  selected  on 
the  option  card  is  printed  as  follows: 

(1)  det  (A)  -  a  scalar 

(2)  A   -  a  matrix  presented  one  row  at  a  time 

C3) ,  (4)   resolvent  matrix  and  characteristic  polynomial. 


*(s)  -  [sI-A]~  ,  which  is  called  the  resolvent  matrix, 
is  the  Laplace"' trans  form  of  the  state  transition  matrix 

4>(t)  =  e~fc. 
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The  coefficient  matrix  of  the  numerator  of  the 
resolvent  matrix  appears  first,  followed  by  the  character- 
istic polynomial  in  ascending  powers  of  s. 

(5)  Eigenvalues  -  listed  indicating  the  real  and  imaginary 

parts 

(6)  Time  domain  state  transition  matrix  -  $ (t)  (see  part  c, 

example  two) . 
The  subprogram  is  restricted  by  the  fact  that  $ (t) 
cannot  be  calculated  if  eigenvalues  are  multiple.   If  a  situa- 
tion where  the  state  transition  matrix  is  requested  where 
eigenvalues  are  not  simple,  a  message  is  printed  (see  part 
c,  example  one)  and  the  computer  goes  to  the  next  problem. 
Note  that  eigenvalues  are  considered  to  be  identical  if  their 
real  parts  and  their  imaginary  parts  differ  by  less  than 
0.005. 

c.   Examples 

(1)   Example  One 

The  resolvent  matrix  (si  -  A)    and  the  state 
transition  matrix  $ (t)  are  to  be  found  for  the  plant  matrix 


0  10" 
0  0  1 
0     0    -2 


Thus,  the  matrix  has  dimension  N  =  3.   The  options  are  set 
equal  to  the  following  values: 
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option  det  =  1 
option  inv  =  1 
option  phi(s)  =  0 
option  C.E.  =  0 
option  eigen  =  0 
option  phi (t)  =  0 


determinant  value  is  not  desired 

inverse  A   is  not  to  be  calculated 

<$>  (s)  is  desired 

characteristic  polynomial  is  desired 

eigenvalues  are  to  be  computed 

<J>  (t)  is  desired. 


£P- 


The  computer  card  deck  is  then: 

//  (standard  OS  JOB  card) 

//  EXEC  LINCON 

//LINK.SYSIN^DD^* 

_ INCLUDE „SYSLIB  (BASxMAT) 

/* 

//GO.SYSIN^DD,,* 
BASMAT  TEST  ONE  03 
0.0      1.0      0.0 
0.0      0.0      1.0 
0.0      0.0      -2.0 
110000 

/* 

The  computer  results  shown  in  Fig  3-12  can  be  interpreted  as 
follows: 


<t>(s)   = 


— 3 2~ 

(s  +2s  ) 


2 

s  +2s 


s+2 

2 
s  +2s 


1 
s 


1 

T 

s 

1 

s 


s  (s+2) 

1 
s(s+2) 

1 
s+2 
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•<AS!r.  MAT-M*  Ph(J(JPiM 
PROBLEM  lDf>  TIFICATION- 


BASfAT  TEST  ONE 

»■•«»•«  »»••■»»*•»»«»»»»•»»»»*»»»»»»»■■.««**•*«*•* 

THt  &  MATRIX 

4.3UC000OE  00        2.GC1CGGL-E  00        1.0C00000E  00  ' 
O.J  c.CCCCOOCE  00        l.OOOOOOOE  00 

O.J  -V.OCCCCCC?  00        2.0000000F  00 

THE  MATRIX  COEFFICIENTS  CF  THE  NUMERATOR  PF  THE  RESOLVENT  MATRIX 

THP  MATRIX  CCCFFICIENT  CF  5**2 

l.JCCOOOOE  00        J.O  0.0 

0.0  l.CCCCCCCE  CO        0.0 

0.0  0.0  l.OOOOOOOE  00 

THE  MATPlX  COEFFICIENT  L  F  S**l 

-8.0CCJC00E  00        i.OCOOCGCE  00        l.OOOOOOQF  00 

0,0  -6.cc:c:ccc  oo     i.ocoooooe  oo 

0.0  -4.0CCC0l.0c    01  -l.OCOOOOOF    01 

ThF    MATRIX    COEFFICIENT    CF    S»*0 

1.59999*56    01  -3.0C0CC0CE    00  -<«.0000000r    00 

CO  7.VSS<;j<t7E    03  -4.0000001E    00 

0.0  1.6CCCCCGE    01  2.3999985c    01 

THE    CMAPACTEF  ISTIC    PCLYf-C"!  AL    -    IN    ASCENOING    POWERS    OF    S 

-6.3999965E    01  4.79>9965E    01  -1.2000000E    01  l.OOOOOOOE    00 


THE    EI.ENVALUFi  OF    THE    A    MATRIX 

3EAL     PART  IMAGINARY     PART 

4.00G1345E    00  0.0 

<».C0C13stt    00  0.0 

3.9*9/<!*<!fc    0(J  0.0 

•  •■WA6f,ING»*« 

Fir.E'.WALOtS  HUST  BE  SIMPLE 

CALCULATIONS  CAMNuT  8E  CIMPLETEO  e0R  THIS  PROBLEM 


Figure    3-12      BASMAT   Test   One 
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The  state  transition  matrix  <f>  (t)  cannot  be  obtained  since  the 
eigenvalues  are  not  simple. 
(2)   Example  Two 

This  second  example  shows  the  complete 
solution,  i.e.,  determinant,  inverse,  resolvent  matrix, 
characteristic  polynomial,  eigenvalues  and  state  transition 
matrix,  for  a  case  where 


A  = 


2.0 

5.1 
0.9 


2.2 

3.4 
1.1 


2.5 

7.1 

1.1 


Since  all  the  calculations  are  requested,  the  option  card  is 
left  blank.   The  card  deck  is 
//  (standard  OS  JOB  card) 
//  J2XEC  JLINCON 
//LINK . SYS IN  JDD  ^* 

INCLUDE  SYSLIB(BASMAT) 

/* 

//GO. SYS IN ^DD^* 

BASMAT  TEST  TWO  03 

2.0  2.2      2.5 

5.1  3.4  7.1 
0.9  1.1  1.1 
(blank  card) 

/* 
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Results  appear  in  Fig  3-13.   Interpretation  of  these  results 
is  fairly  straightforward.   For  instance,  the  first  term  of 
the  resolvent  matrix,  <|>(s),  is 


2 

a   /«\         s   -  4.5s  -  4.07 

*ii(s)    -  1 — m — 


s   -  6.5s   -  8.54  s  +  0.049 

and,  similarly,  the  first  term  of  the  transition  matrix, 
4>(t)  ,  is 


♦u(t)   =   (0.475e+(K0057t  +  0.229e-1*13t  +  0.296e+7 '  62t) 


2.   Rational  Time  Response  (RTRESP) 

This  subprogram  may  be  used  whenever  it  is  desired  to 
obtain  the  time  response  in  closed  form  [1]  of  a  linear  control 
system  described  by  the  following  set  of  equations: 

x(t)   =  A  x(t)  +  b  u(t) 

u(t)   =   K[r(t)  -  kT  x(t)] 

y(t)   =   c  x(t) 


The  system  can  have  any  initial  conditions  x (t  )  but  the  scalar 
forcing  function  r(t)  must  have  a  rational  Laplace  transform 
such  that 


N  ( s) 
[r(t)]   =   R(s)   =   G   :  ■   ,  where  G  is  a  constant, 
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•<A51L     "Art.  IX     t-t-  C  (,PA  •« 

PRCIOLE*    IDENTIFICATION-  eAS"4T    TEST    TWO 

THE    A     MATP IX 

2.UOJ00OOE    00                    2.1S9SS98E    00  2.5C0O0OOF    00 

5.0S^S9<,£     00                    J.3S999S6E    00  7.0999994E    00 

H.9999S9BF-01                      1.0999994c    00  1.0999994E    00 

THE    DETEP^INAf.T    QF    THE    ►  ATMX 

-4.90014:J5F-02 

THE    INVERSE    CF    THF    ^MMX 

6.3061829E    01                 -6.734721<;E    00  -1.4530740E    02 

-1.59lb<.66c    01                    1.0204U5E    00  2.9592041?    01 

-5.2041229E    CI                    4.4896157E    00  9.0204926E    01 

THE    MATFIX    COEFFICIENTS    OF     TF£    NUMERATOR    OF    THE    RESOLVENT    MATRIX 

THE    MATRIX    COEFFICIENT    CF    S»*2 

l.OOOJOOOE    00                 -3.C517570E-05  -1 .5258789E-05 

0.0                                              I.CCCCCCCE    00  -1.525i7B9E-05 

0.0                                              6.1035156E-C5  l.OCOOOOOE    00 

THE    MATHX    CCEFFICIENT    CF     S**J 

-4.*<}9-*990F    00                    2.19-)".998  =    00  2.500000PE    00    ■ 

5.099S994E    00                 -3.C999994E    00  7.0999914E    00 

6.999999dF-01                    l.C9>79994E    00  -5.3999996E    00 

THE    *AThlX    COEFFICIcNT    CF    S*»0 

-4.0699921F    UO                    3.2999992E-01  T.U99961E    00 

7.7VS9733C-C1                 -4 .9994469 '-02  -1.4500122F    00 

2.54<)996<»E    00                  -2.1999S31E-01  -4.4199924E    00 


THc    CHAFACTtMSTIC    PClYfiCMIJSL    -    IN    ASCENOING    POWERS    OF    S 
4.9001485F-02  -8.5399904E    00  -6.4999990E    00  l.OOOOOOOE    00 

•«•«•«»»..».  «»»»«•»•»«»»•«»*. t»»»»»»*-»« ******* 

THE    EIGENVALU€S    OF    THF     \    MATRIX 

REAL    PAfcT  I^iGINARV    PART 

5.713UO42F-03  O.O 

-i.U5ol/0f     00  0.0 

7.ol990J7fc    CO  0.0 

«•••»»■••«»»•*»»****«**»*»«*»»«•*»»**♦***»*»* 

THt    eLEME'JTS    PF    THE    STlTfc    TRANSITION    matrix 

ThE    MATRIX    COEFFKI  =  NT    CF    EXP«     5. 713064^-01 »  T 

4.75457J7E-01  -3.97o9i3it-0?  -S.2820415E-01 

-9.39i27*oc-02  7  .85*  1  59  7  =  -03  1.6361809F-01 

-2.96to2o*7F-01  2.44G9659E-02  5  .  I6t>  J453<=-01 

THE    matrix    CCEFUCICNT    CF    t  XP  I -1  .  125617E    00>T 

2.28fc5254=-Cl  -2.169324PF-01  4. 3520^46^-01 

-5.01375<.<.t-01  4.75'-*274t-0t  -9.54297 07F-OI 

1.553399UL-01  -1.473726UC-01  2.9566765E-01 

THE    MATRIX    rCEFFICIEfcT    CF    EXPC    7.619901?    OOIT 

2.95d9075f-0l  2.5670 183E-01  3.92998 10C-01 

5.9530647E-CI  •>.  16462 15c-01  7.9CG7850E-01 

i.412b095E-01  I.225t914c-Cl  1 .8764746F-01 


Figure    3-13      BASMAT   Test  Two 
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and 


N(s)   =   aQ  +  axs  +  a2s2  +  ...  +  s£ 


D(s)   =  bQ  +  bxs  +  b2s2  +  ...  +  sm 


with  m  >  £  >_  0. 

Arrange  the  polynomials  so  the  coefficients  in  the  highest 
order  terms  of  both  N(s)  and  D(s)  are  unity  and  select  the  input 
gain  G  as  required. 

In  addition  to  the  above,  it  is  necessary  that  the 
total  order  of  the  system,  i.e.  order  of  D(s)  plus  dimension 
of  A  be  smaller  than  or  equal  to  ten.   This  limitation  is  not 
overly  restrictive  but  must  be  taken  into  account  when  handling 
large  order  systems. 

a.   Input 

The  system  matrices,  feedback  coefficients  and  the 
controller  gain  are  entered  immediately  after  the  problem 
identification  and  system  order  card.   The  A  matrix  elements 


are  presented  one  row  at  a  time.   The  transpose  control  vector 

:1'  k2 


T 
b  ,  the  output  vector  c,  the  feedback  coefficients  k..  ,  k- , 


k3 ,  . . . ,  k   and  the  controller  gain  K  are  given  using  an 
8F10.4  format. 

Next  the  initial  conditions  x,  (0),  x„C0),  ..., 
x  (0) ,  the  input  gain  G  and  the  numerator  and  the  denominator 
input  polynomials  are  entered.   Both  N(s)  and  D(s)  may  be 
entered  in  factored  (F)  form  or  unfactored  (P)  form  and  it  is 
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noted  that  the  degree  of  D(s)  must  be  strictly  larger  than  the 
degree  of  N (s) . 

It  is  suggested  that  a  signal  flow  graph,  or  at 
least  a  matrix  block  diagram,  be  sketched  before  an  attempt 
is  made  to  run  this  subprogram.   It  does  not  take  long  to  do 
so  and  much  can  be  gained. 

The  execution  time  for  the  subprogram  is  less  than 
20  seconds  for  most  cases  (class  A) . 


Entry    Input  Description 

1  Problem  identification,  order 
of  the  system  (N  <_  10) 

2  plant  matrix  A  (one  row  per 
card  if  N  <_   8 ;  one  row  per 
two  cards  if  N  >  8) 

T 

3  Control  matrix  b  (1  xN) 

(on  one  card  if  N  <  8; 
two  cards  if  N  >  8) 

4  Output  vector  g(l  x N) 

(on  one  card  if  N  <_  8, 
on  two  cards  if  N  >  8) 

5  feedback  coefficients  k,,k2 
.  .  .  ,  k   (on  one  card  if 

N  <_  8;non  two  cards  if  N  >  8) 

6  Controller  gain  K 


Format    Columns  Used 
5A4,  12    1-20,  21-22 


8F10.4     1-10,  11-20, 
etc. 


8F10.4     1-10,  11-20, 
etc. 


8F10.4     1-10,  11-20, 
etc. 


8F10.4     1-10,  11-20, 
etc. 


8F10.4     1-10 


7  Initial  condition  x,  (0), 
x2  (0)  ,  .  .  .  ,  x  (0)  (on  one 

card  if  N  <  8,  on  two 
cards  if  N  >  8) 

8  Input  gain  G 

9  Letter  P  or  F  (for  P  form 
or  F  form) ,  polynomial 
order  i    <   M 


8F10.4     1-10,  11-20, 
etc. 


8F10.4     1-10 
Al,  12     1,  2-3 
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Entry   Input  Description 

10  Enter  N(s)  in  format 
specified  on  the  previous 
card. 

11  Letter  P  or  F  (for  P  form 
or  F  form) ,  polynomial 
order  M  ;  10 

12  Enter  D(s)  in  format 
specified  on  the 
previous  card. 


Format    Columns  Used 

8F10.4     1-10,  11-20, 
etc. 


Al,  12     1,  2-3 


8F10.4     1-10,  11-20, 
etc. 


Table  VII  -  Input  Format  Table  for  RTRESP 

b.   Output  Format 

All  the  information  given  as  input  is  repeated 
for  reference.   The  polynomials  N(s)  and  D(s)  are  presented 
both  in  factored  and  unfactored  forms. 

The  rational  time  response  of  each  component  of 
the  state  vector  x(t)  and  the  scalar  output  y(t)  are  printed 
in  pseudo-matrix  form.   Here  again  a  hypothetical  example  can 
clarify  the  presentation.   For  a  two-state  problem,  assuming 
complex  poles  and  a  step  input,  the  computer  output  would  look  like 

THE  TIME  RESPONSE  OF  THE  STATE  X(t) 

THE  VECTOR  COEFFICIENT  OF  EXP(A)T  *  COS(B)T 

xll  X12 

THE  VECTOR  COEFFICIENT  OF  EXP (A) T  *  SIN(B)T 

x21  X22 

THE  VECTOR  COEFFICIENT  OF  EXP  (0.0) T 


'31 


"32 
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where  ^l'  x12 '  x21'  x22'  x31  and  x32  are  numbers*   Tne  result 
would  be  interpreted  as: 

x1(t)   =  xi;l  *  exp(at)  *  cos(bt)  +  x21  *  exp(at)  *  sin(bt)  +  x31 


x2(t)   =  x12  *  exp(at)  *  cos(bt)  +  x22  *  exp(at)  *  sin(bt)  + 


k32 


The  procedure  to  obtain  y(t)  is  the  same.   Note 
that  if  more  than  one  output  y(t)  is  desired,  the  subprogram 
must  be  rerun  changing  the  c  matrix  each  time, 
c.   Example 

The  open-loop  rational  time  response  is  desired 
for 


Y(s)   _ 
X(s) 


.1923 


s   +  2.346s  +  3.846 


The  first  step  is  to  get  the  signal  flow  graph 
and  state  equations. 


.1923 
R(s)  o >- 


O  Y(s) 


-3.846 


Fig  3-14    Control  System  for  RTRESP  Test 
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x1(t)   =  x2(t) 


x2(t)   =   -3.846x1Ct)_^  2.346x2(t)  +  .1923u(t) 


u(t)   =   r(t) 


y(t)   =  xx(t) 


The  data  from  the  system  is  then: 


A  = 


Q .  a    i .  a 

J73.846    -2.346 


b    =   [0.0     .1923] 

C   =   [1.0     0.0] 

kT   =   [0.0     0.0] 

K  =   1.0 

x(0)   =   0 

The  system  time  response  in  closed  form  is  required 
for  a  step  input  of  magnitude  2.   Thus 


R(s)   =  | 
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and  the  data  are 

input  gain  =  2 
N(s)  =  1 
D(s)   =   s 

The  control  and  data  cards  to  run  the  program  are  as  follow: 

//  (standard  OS  JOB  card) 

//^EXEC^LINCON 

//LINK. SYS IN^DD  * 

_ INCLUDE ^SYSLIB (RTRESP) 

/* 


02 


//GO. SYS INA DD^* 

RTRESP 

TEST 

0.0 

1.0 

-3.836 

-2.346 

0.0 

0.1923 

1.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

2.0 

POO 

1.0 

F01 

0.0 

/* 
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The  results  shown  in  Fig.  3-15  are  interpreted  as: 

xx(t)   l  -.1  *  exp(-1.173t)  *  cos(1.57t)  -  .075  *  exp(-1.173t) 

*  sin(1.57t)  +  0.1 

x2(t)  2.     0-245  *  exp(-1.173t)  *  sin(1.57t) 

y(t)   =  Xl(t) 

3.   Graphical  Time  Response  (GTRESP) 

The  subprogram  is  a  slightly  modified  version  of  the 
one  presented  by  Melsa  and  Jones  [1] .   It  still  determines  the 
time  response  of  the  closed  loop  system 

x(t)   =  A  x(t)  +  b  u(t) 

u(t)   =   K[r(t)  -  kT  x(t)] 

y(t)   =  c  x(t) 

with  initial  conditions  x(t-.)  and  displays  the  results  both 
in  tabular  and  graphical  forms.   However,  instead  of  having 
all  the  desired  plots  drawn  on  one  graph  only,  it  also  produces 
one  graph  for  every  selected  variable. 

The  subprogram  solves  linear  systems.   It  is  a  Class 
B  job  when  graphical  output  is  requested  but  reduces  to  a 
Class  A  job  when  tabular  output  only  is  to  be  listed.   The 
subprogram  must  be  accessed  under  Mode  Two  and  requires  an 
exterior  subroutine  to  define  the  scalar  forcing  input  r(t). 
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PRGcJlE*    IDENTIFICATION   -    RTRESP    TFST 


THg     A    MATRIX 

0.0 
-3.84599S7 

1.3000000 
-2.3*59997 

ThE    B    »»ATRIX 

0.0 

C. 1923000 

THE    C    WATRIX 

1.0003300 

CO 

FEFOBAC*    CCFFF. 

3.0 

0.0 

GAJ»«    »       1.CCC3000E 

00 

INITIAL  CONDITIONS  -  XJO) 

0.0  0.0 

RC&IN    »      2.O0G3OOCF    00 
NU»ERATCR    PCLYNCIAL    OF    RJSI    -    ASCFNOING    PPWFRS    OF    S 

i.cc:ooco 

OENO"lNATO<*    POLXNCMIAL    OF    RCSJ    -    ISCENOTNG    PCWEPS    OF    S 
0.0  1.0030000 

D£v:*I'IAT?P    BOOTS    A'E 

REAL    F\cT  l"AG.    PAST 

■  J  . 0  0.0 


T»-E  T|wfe  R£SP-,ISC  CF  THE  STATP  X(TJ 

THc    V6CT00    fCrPFICI  =  NT    OF  EXPI-1 . I 7?999c    00  )T*COS ( 1 .571647E    00 > T 

-0.10330GO  0.:03C30l 

THE    VECTOR    fCEePICITNT    CF  EXP1-1.17>°99F    00  )T*S IN ( I .5 7 1647E    OOJf 

-J.07'.635C  C'.'.Tll* 

THE    VFCTC*    CTrFFICIENT    CF  E*F<    0.0                          »T 

3.0S-»9S-*<.  -C.COOOOOt 


ThE    TfF    *  =  SCCNSF     CF    THf     OUTPUT    Yf  T  > 


THE   COEFFICIENT    3F    EXP l-l. 1 72999E    00  I T*CPS ( 1 .571 647E    00) T 
-U. 1000000 

THE    COEFFICIENT    OF    E XP 1-1 . 172999E    00 |T*STN( 1 .571647*    OOIT 
-0.07*6?50 

THE    COEFFICIENT    TF    gxP«    O.C  IT 

O.G»*9-*SS 


Figure    3-15      RTRESP  Test   -   Computer  Output 


87 


a.   Input 

The  first  element  to  be  input  is  the  forcing  func- 
tion r(t).   A  short  defining  subroutine  must  be  written  in 
the  following  manner: 

SUBROUTINE  RFIND(T,R) 
(FORTRAN  statements  defining  r(t)) 
(Example:   R  =  2 . 5*T+SIN (4 . 2*T) 
RETURN 
END 
Next  the  remaining  parameters  are  entered  as  a  data  deck  which 
closely  resembles  the  one  for  RTRESP.   The  problem  identifica- 
tion and  system  order  (N  <_  10)  are  given  on  the  first  card. 

T 
Then  the  N  x  N  plant  matrix  A,  the  single  row  matrix  b  ,  the 

T 
output  matrix  c,  the  feedback  coefficient  matrix  k  ,  the  con- 
troller gain  K  and  the  initial  conditions  x(tQ)  are  presented 
as  indicated  on  the  input  format  table.   The  next-to-last  card 
specifies  the  time  factors:   the  initial  time,  the  final  time, 
the  integration  step  size  and  the  frequency  of  output  are 
given  in  an  8E10.0  format.   The  last  card  enumerates  the 
variables  to  be  plotted  versus  time. 

Here  some  specifics  regarding  the  time  specifications 
and  the  variables  to  be  plotted  must  be  remembered. 

(1)   Common  sense  must  be  used  when  selecting  the  initial 
and  final  time.   Intelligent  guesses  should  be  made  based  on 
experience  and  the  system  dynamics. 
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(2)   The  integration  step  size  is  also  related  to  the  system 
dynamics.   It  should  be  small  enough  to  give  a  precise  solu- 
tion but  not  excessively  small  as  to  increase  the  computing 
time  unnecessarily.   As  a  rule  of  thumb  one  can  start  by 
letting  the  integration  step  size  be 


nT     (final  time)  -  (initial  time) 

1000. 


(3)   The  frequency  of  output  (FREQ)  determines  both  the 
number  of  points  to  be  plotted  in  the  total  time  interval  and 
the  physical  dimension  of  the  graph.   The  formula  to  determine 

the  value  of  FREQ  is 

FRE0  _  (final  time)  -  (initial  time) 

y    (integration  step  size) (number  of  points  to  be  plotted 

=  (No.  of  time  steps) /(No.  of  points  plotted) 

where  the  number  of  points  to  be  plotted  must  always  be  less  than 
or  equal  to  100.   Equivalently  one  can  say  that  the  plotting 
is  constrained  by  the  equation 


(final  time)  -  (initial  time) 
FREg  -  (integration  step  size)  (100) 


This  relationship  is  very  important.   It  restricts  the  user 
but  also  permits  him  to  establish  in  advance  the  number  of 
points  to  be  plotted  per  curve  and  the  scaling  of  the  time 
axis.   This  is  illustrated  by  the  following  example. 

Assume  that  the  initial  time  is  0.0,  the  final  time 
is  10.0  and  the  step  size  is  0.005.   What  value  should  be 
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used  for  the  frequency  of  output,  FREQ?   Using  the  rule 
stated  above, 


frfo   >   (10.0  -  0.0)      on 
FREQ  -   (.005)  (100)    "   20 


Thus  the  frequency  of  output  must  be  greater  than  or  equal  to 
twenty.   Expecting  a  moderately  oscillating  time  response,  a 
"number  of  points  to  be  plotted"  equal  to  fifty  is  decided 
upon .   Thus , 


frfo  -   (10  ~  0)         An 
FREQ   "   (.005) (50)    "   40 


giving  a  sampling  interval  (S.I.) 

S.I.   =   (FREQ)  (Step  Size)   =   (40)  (.005)   =   0.2 

In  summary,  for  this  example,  setting  FREQ  equal  to  40  would 
give  an  output  of  50  points,  each  0.2  seconds  apart  between 
the  initial  value  TI  =  0.0  and  the  final  value  TF  =  10.0 
seconds. 

Note  that  the  physical  dimension  of  the  graph  is 
directly  proportional  to  the  number  of  points  to  be  plotted. 
Fifty  points  usually  gives  a  good  drawing  and  is  suggested  as 
starting  value. 

(4)  Approximate  equations  for  the  graph  dimension  are  pre- 
sented as  extra  information  only.  These  do  not  help  to  solve 
the  problem  but  give  an  idea  of  what  to  expect: 

90 


dependent  variable  or  y  axis  =  36  cm  (fixed) 

independent  variable  or  t  axis  =  (. 318) x (number  of  points)  cm 

The  last  card  of  the  data  deck  indicates  what  dependent  varia- 
bles are  to  be  plotted.   A  maximum  of  eight  graphs  can  be 
output  for  every  program  run.   If  tabular  output  only  are 
desired,  the  last  card  is  left  blank.   The  variables  for  which 
time  responses  are  to  be  drawn  are  specified  by  giving  the 
symbol  that  corresponds  to  the  desired  variable: 


Symbol 

Variable  to 

be 

plotted 

Symbol 

Variable  to  be  plotted 

1 

xl(t) 

8 

x8(t) 

2 

x2(t) 

9 

x9(t) 

3 

x3(t) 

S 

xlO(t) 

4 

x4(t) 

R 

error  signal 

5 

x5(t) 

U 

controller  input 

6 

x6(t) 

Y 

output 

7 

x7(t) 

R 

forcing  input 

Table  VIII  -  Symbol  Indicating  Variables 
to  be  Plotted  by  GTRESP 


where  the  error  signal  is  defined  as 


e(t)   =  r(t)  -  y(t) 


All  the  above  is  summarized  by  the  following  table 


91 


Entry   Input  Description 

1  Problem  identification,  order 
of  the  system  (N  <_  10) 

2  Plant  matrix  A(NxN)  (one  row 
per  card  if  N  <  8  or  one  row 
per  two  cards  if  N  >  8) 

T 

3  Distribution  matrix  b   (1  x  n) 

(one  card  if  N  <  8  or  two 
cards  if  N  >  8) 

4  Output  vector  c  (1  x  n)  (one 
card  if  N  <  8  or  two  cards 
if  N  >  8) 

5  feedback  coefficients  k, ,  k  , 
. . . ,  k   (one  card  if  N  <  8 

or  two  cards  if  N  >  8) 

6  Controller  gain  K 

7  Initial  condition  x, (tQ) , 
x2 (t  ) ,  . ..,  x  (t  )  (on  one 

card  if  N  <  8  or  two  cards 
if  N  >  8) 

8  Initial  time  TI , 
final  time  TF, 
step  size  DT, 
frequency  of  output  FREQ 

9  Any  of  the  following  symbols 
in  any  of  the  first  eight 
columns  of  the  card  (maximum 
of  8)  : 

Y,R,U,E,1,2,3,4,5,6,7,8,9,A 


Format    Columns  Used 
5A4,  12    1-20,  21-22 


8E10.0     1-10,  11-20, 
etc. 


8E10.0     1-10,  11-20, 
etc. 


8E10.0    1-10,  11-20, 
etc. 


8E10.0 

8E10.0 
8E10.0 


8E10.0 


8A1 


1-10,  11-20, 
etc. 


1-10 

1-10,  11-20, 
etc. 


1-10, 
11-20, 
21-30, 
31-40. 

1,2,3,4,5,6,7,8 


Table  IX  -  Input  Format  Table  for  GTRESP 

b.   Output 

T      T 
The  problem  identification,  A,  b  ,  c,  k  ,  K,  x(t  ), 

the  initial  time  TI,  the  final  time  TF,  the  integration  step 

size  DT  and  the  frequency  of  output  FREQ  are  printed  out  for 

future  reference.   Then  the  tabular  output  of  all  the  state 
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variables  together  with  the  control  input  u(t)  and  the  output 
y(t)  are  listed  versus  time.   Finally,  the  graphical  outputs 
are  given.   As  mentioned  earlier,  one  graph  is  produced  for 
each  selected  variable.   At  the  end  of  the  run,  a  compact 
solution  is  presented  by  plotting  all  the  curves  on  a  single 
graph. 

c.   Example 

An  uncompensated  system  is  described  by 


Kx(t)   =   x2(t) 


x2(t)   =   u(t) 


The  system  is  compensated  by  feeding  back  both 
states  and  the  graphical  time  response  is  to  be  obtained  for 
initial  condition  only.   The  initial  conditions  are  x..  (0)  =  10.0 
and  x2 (0)  =  0.0.   The  controller  gain  equals  1.6. 

The  following  diagram  represents  the  complete 
system: 


r(t) 


!9 


& 


K 


*  / 


x2  ftl 


=>  / 


•^Ctl 


Fig  3-16   Feedback  System  for  GTRESP  Test 
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Since  only  the  time  response  to  initial  conditions  is  required 
for  the  problem,  r(t)  is  set  equal  to  zero.   The  system  order 
is  two  and 


A  = 


lp     0. 


bT  =   [0     1]  ,   C  *   [0     0] 


T 
The  feedback  coefficient  matrix  k   =   [1.     1.] 

The  controller  gain  K  =   1.6 

The  initial  conditions  x(0)   =   [10.     0] 

From  the  dynamics  of  the  system,  a  final  time  of  10 

seconds  is  chosen. 

An  integration  step  size  of  0.02  is  sufficiently  small 

The  time  equations  imply  that 


(1)  FREQ   >   (1°  "-  0) 


-   (.02)  (100) 


(2)   50  points  are  chosen  to  cover  the  ten  second 
interval  so 


FREQ  =   I.02M50)   "  10 


(3)  One  value  is  going  to  be  plotted  every  (DT) x (FREQ) 
or  0.2  second. 

(4)  The  estimated  dimensions  of  the  graph  can  be  evaluated 
as 
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-  dependent  variable   axis  =  36  cm 

-  independent  variable  axis  =  (.318)  (50)  =  15.9  cm 
The  variables  to  be  plotted  are  u(t),  x, (t)  and  x2 (t) . 

All  the  above  are  entered  as  specified  on  the  input  format 

table  and  the  subroutine  RFIND(T/R).   The  complete  computer 

cards  set  up  is  then: 

//  (standard  OS  JOB  card) ,TIME=2 

/AEXECLINCONF 

//FORT . SYS IN  JDD  A * 

SUBROUTINE    RFIND(T,R) 

R=0.0 

RETURN 

END 

/* 

//LINK. SYS IN ^DD^* 

A A INCLUDE (GTRESP) 
^ENTRY^GTRESP 

/* 

//GO.SYSIN^DD^* 

GTRESP  TEST  02 

0.0  1.0 

0.0  0.0 

0.0  1.0 

0.0  0.0 

1.0  1.0 

1.6 

10.0  0.0 


95 


0.0     10.0     0.02     10. 
12U 

/* 

Results  are  shown  in  Fig.  3-17A-E 

D.   MODERN  CONTROL  SUBPROGRAMS 

The  following  set  of  subprograms  may  be  used  to  analyze 
and  design  linear  feedback  control  systems  which  are  to  achieve 
a  specified  closed-loop  transfer  function. 

This  group  of  nine  subprograms  consists  of:   the  supporting 
subprograms  OBSERV,  CONOBS,  SENSIT  which  provide  the  user 
with  a  means  of  checking  the  observability  and  controllability 
of  a  system  and  its  sensitivity  to  parameter  variations;  the 
subprograms  STVAR,  LUEN  and  SERCOM  which  help  design  optimal 
linear  control  systems  with  complete  or  incomplete  state 
measurements;  RICATI  and  KALMAN  which  find  the  feedback  and 
control  gains  necessary  to  optimize  a  given  function  either 
for  continuous  or  discrete  systems;  finally,  MIMO  which  is  a 
computer  aided  technique  to  determine  feedback  control  laws 
for  multiple-input  multiple-output  systems  where  the  number 
of  inputs  equals  the  number  of  outputs. 

The  subprograms  SENSIT,  KALMAN  and  RICATI  are  normally 
Class  B  subprograms  and  require  a  "TIME  =2"  specification  on 
the  JOB  card.   All  others  are  Class  A.   Except  for  KALMAN 
which  must  be  operated  using  Mode  Two,  all  the  subprograms 
are  accessed  under  Mode  One  or  Mode  Three. 
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r.H«mir.AL   l!»t   k.-SPCuSi. 

PHl'-M.!*    TotVUFICATlCN   -   GTR6SP    TEST 

THE  A  MATRIX 


0.0 
0.0 


I.OO00G0C0E  00 
0.0 


THE  B  MATRIX 
0.0  l.CCCCCCCCE  00 

THE  C  MATRIX 
0.0  0.0 

FFSD3ACK    CCFFP. 
1.0O0030O0E    00  l.CCCCCCCCE    00 

GAI  4    »  1.59999943E    30 

INITIAL    CUNCITIGNS 

l.ooouooooe  oi  o.o 


TZE<*0    *         0.0 
OT    *         0.020CCJ 


TF    »       10.000000 
FPEQ    »  IC 


•••••••••a******************  »»»»»«•»..*»»•»*« 


0. 

3 

0.0 

1. 

59*9S8E- 

•01 

O.O 

3. 

9<W9  9eE- 

•01 

CO 

5. 

9999-,4E- 

-0  1 

0.0 

7. 

i99992=- 

■01 

0.0 

9. 

9W99..F- 

■01 

CO 

1. 

1999o3fc 

GO 

CO 

1. 

3999  70E 

CO 

CO 

1. 

:>939:>oF 

00 

0.0 

L. 

799<,~1E 

cO 

CO 

1. 

?r;9?7E 

CO 

CO 

2. 

19-9-,12  = 

00 

CO 

<;. 

199  8  9a*  E 

CO 

0.0 

2. 

5  >  9  -3  o  2  E 

oc 

0.0 

2. 

79*c695 

oo 

0.0 

2. 

■»99  -  >-»5 

00 

0.0 

3. 

199340F 

00 

CO 

3. 

39-,a25E 

CO 

CO 

3. 

5;9j>!  IE 

CO 

0.0 

3. 

79>»79oE 

00 

CO 

3. 

■»  >  V  7  o  2  5 

00 

CO 

4. 

1 5 J  76  7  = 

0  0 

0.0 

4. 

->^W53F 

00 

0.0 

4. 

5997  ice 

00 

CO 

t. 

7^72-e 

0  0 

CO 

4. 

99WC-*E 

cO 

cc 

3. 

199695E 

00 

0.0 

3. 

»99o3 Ot 

00 

cc 

5. 

5-j^o6c/E 

CO 

CO 

5. 

79V651 E 

JO 

CO 

5. 

999637E 

00 

CO 

b. 

!99o22E 

00 

cc 

6. 

i99oC3E 

00 

CO 

6. 

5V,5t3E 

oc 

cc 

6. 

799579E 

CO 

CO 

6. 

1   7  9  5  O  4  F 

00 

CO 

7. 

I S953JE 

oc 

0.0 

7. 

1995355 

00 

CO 

7. 

39-,521E 

00 

cc 

7. 

7995C6E 

-0 

CO 

r. 

9994921 

00 

CO 

o. 

t  ->  i  4  7  7E 

vC 

b  •  \* 

a. 

i99463E 

jO 

CO 

8. 

5<v94<.;iE 

oc 

0.0 

3. 

79943*E 

00 

CO 

a. 

999419E 

00 

CO 

s. 

1994u5E 

00 

0.0 

V. 

34-.3906 

GO 

CO 

9. 

399  3  7oc 

00 

0.0 

9. 

79-,36iE 

00 

CO 

9. 

999347E 

00 

CO 

YITJ 


U(T) 

-1.439999=    01 

-1.CC6522F    01 

-6.H02625E    0.2 

-3.37S7CC5    CO 

-1.000483?    00 

7.6  16846=-01 

2.03^217=    00 

2.c3i25'E    00 

3.256497=    00 

3.367876=    CO 

3.298706=    CO 

3.054247=    00 

2. 71 03 3 55   00 

2.  512944='    33 

l.H9?3  76=    CO 

1.4929.  7E    00 

1.1  Udil^    03 

7.6551065-01 

5.CCt76jE-01 

2.  6  6  5o  7 '15 -01 

3.<:047  76C-C2 

-5.t4UC5  =  -02 

-1.5367-.65-01 

-2.162731E-0' 

-2. -.9  79  75c-Ol 

-2.6C52245-GI 

-2.54;;i  JE-OI 

-2.356427F-01 

-2.C93759=-0l 

-i.  78E921P-01 

-1.470U6E-01 

-1.15S5Q6E-0! 

-8.o912  17--02 

-6.1  U359=-02 

-3.913396E-J? 

-2.1CCe7"-02 

-6.c96437r-C3 

4.CS72  32F-03 

1.164673E-02 

L.e52l9'E-02 

£.Sl62LV=-G2 

I  !«j  577*115-0?! 

1.6177635-02 
l.fcl 70loF-02 
1.36  27  96F-0? 
1. 13739  05-02 
8.9724255-0" 
6.739  765r-03 
4.75l-29=-03 
2.0466,':>E-03 


X'.(T)  X2(T) 

l.CC00CC=  01  CO 
9.741759=  00  -2.4384935  00 
9.3779955  00  -4.0763535  00 
8.155920c  00  -5.14  3607=  00 
7.C°65C7'u  00  -5.471205F  00 
5.995084^  00  -5.4836375  00 
4.9231595  00  -5.1939205  00 
3.9^  048C  00  -4.70358'E  00 
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1.634094':  00  -7.7457875  00 
L.19<?491F  00  -2.1033^65  00 
a.367298L-0l  -1.530690E  00 
5.  322073  =  -0l  -1.027799=  00 
4.201474=-C1  -6.0o6336=-01 
-?.'>77559F-0• 
-7. 0930291-03 
l.625733=-01 
3.1035  iOc-O? 
3.3623245-01 
4.2029065-01 
4.22  12505-01 
4. 0046025-01 
3.f>2  9i  \  iE-Ot 
3.15  3  7..  J- -01 
2.-..451  J4=-01 
2.'  2  8O21F-01 
1.6366095-01 
1.  190ol2E-01 
8.01 8959=-C2 
4. 75955a5-02 
2.123351E-02 
1.10575^5-03 


_  ,  ?4D575E-01 

3.C7M233F-01 

3.2643245-01 

3.767242F-01 

4.4716275-01 

5.284294E-01 

6.  131319--01 

6.957l47=-0l 

7.72?59?E-0l 

8. 4024335-01 

3.98322'»  =  -0l 

9.46T3175-01 

9.336159.5-01 

l.CU799fc    00 

1.031618E    GO 

1.044287-     CO 

1.0510  71=    00 

1.053215=    00 

l.05ld70r    00    -l.36430^"-02 

!.C4rt0t7=     00    -?. *603i6=-02 

l.C426-J6r    0.)    -2.9557275-02 

I.C30452F    00    -3.226.'/75-J2 

1. 02993-5":    00    -3.  'JW330--02 

1.0235755    00   -3.U6 54 02=-C2 

1.0' 76705    00   -?.79958HE-02 

1.012413=    CO    -2.43941  7^-02 

1.CC7926:    00    -2.24 ',3'*  3!! -02 

1.C042321"    00    -t.6468?9  =  -02 

1.001319=    00    -1.26 79  96F- 02 

9.9913C96-01  -9.237256E-03 

9.9759L4--0L    -6.23J9165-03 

9.966047=-0l    -3. 7133 74=-03 

9.96  :7->9£-01     -' .f»c072C5-05 

9.9590C7=-01    -1. I305o2=-04 

9.9599^3"-0l        1.03  15j55-u3 

9.96'380  =  -01        1.3066C5-03 


Figure    3-17A     GTRESP  Test   -  Tabular  Output 
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1.   Observability  (OBSERV) 

This  subprogram  determines  the  observability  index  of 
the  linear,  time  invariant,  Nth  order  system 

x(t)   =  A  x(t)  +  B  u(t) 
y(t)   =  C  x(t) 


The  observability  index  r  of  the  above  system  is 

defined  [4]  as  the  smallest  positive  integer  for  which  the 

T  T  r— 1 

matrix  [C,  AC,  ,  (A  )    C]  has  rank  N. 

a .   Input 

The  problem  identification,  the  order  of  the  system 

and  the  number  of  rows  of  the  C  matrix  are  entered  on  the  first 

data  deck  card.   Then  the  A  matrix  is  presented  one  row  at 

a  time  followed  by  the  C  matrix,  also  one  row  at  a  time. 


Entry    Input  Description 

1  Problem  identification, 
order  of  the  system  (N  <_  10)  , 
number  of  rows  of  C  (M   10) 

2  A  (N  XN)  matrix  (one  row  per 
card  if  N  <  8;  one  row  per 
two  cards  if  N  >  8) 

3  C  (M  xn)  matrix  (one  row 
per  card  if  M  _<  8;  one 

row  per  two  cards  if  M  >  8) 


Format 


Columns  Used 


5A4 

1-20, 

21-22, 

212 

23-24 

8F10.3 

1-10, 
etc. 

11-20, 

8F10.3 

1-10, 
etc. 

11-20, 

Table  X  -  Input  Format  Table  for  OBSERV 
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b.  Output 

The  problem  identification,  and  the  A  and  the  C 
matrices  are  listed  for  reference.   Then  either  " (A,C)  is 
unobservable"  is  printed  or  the  observability  index  is  given. 
(If  the  observability  index  equals  N  the  number  of  states, 
the  system  is  completely  observable.) 

c.  Example 

The  following  set  of  matrices  are  to  be  checked 
for  observability  condition 


(1) 


(2) 


A  = 


A  = 


-1 

-2 

-2 

0 

-1 

1 

_1 

0 

-1 

2 

1 

0 

0 

2 

1 

0 

0 

2 

and 


and 


C  =   [1 


C   = 


0] 


Here,  both  (1)  and  (2)  are  solved  in  the  same  run,  placing  the 

data  decks  one  on  top  of  the  other  giving: 

//  (standard  OS  JOB  card) 

/AEXECLINCON 

//LINK.SYSIN^DD.* 

^ INCLUDE „SYSLIB (OBSERV) 

/* 

//GO.SYSIN  JDD„* 

OBSERV  TEST  ONE     0301 
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-1.0 

-2.0 

-2.0 

0.0 

-1.0 

1.0 

1.0 

0.0 

-1.0 

1.0 

1.0 

0.0 

OBSERV 

TEST   TWO 

0302 

2.0 

1.0 

0.0 

0.0 

2.0 

1.0 

0.0 

0.0 

2.0 

0.0 

1.0 

3.0 

0.0 

2.0 

4.0 

/* 

and  the  solution  is  shown  in  Fig.  3-18. 

2.   Controllability  and  Observability  (CONOBS) 

The  subprogram  is  a  modified  version  of  OBSERV.   It 
is  used  to  determine  the  observability  index  and  check  the 
controllability  of  a  linear,  time-invariant  control  system  of 
the  form 

x(t)   =   A  x(t)  +  B  u(t) 
y(t)   =   C  x(t) 

a.   Input 

The  input  is  the  same  as  for  OBSERV  except  that 

T 
the  B  matrix  must  be  included.   The  input  deck  starts  with 

the  problem  identification  card  which  also  contains  the  system 

T 
order,  N,  the  number  of  rows  of  B,L,  and  the  number  of  outputs, 
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OBSERVABILITY    INDEX    CALCULATION 

PROBLEM    IDENTIFICATION-  OBSFRV    TEST    CNF 

ThE    A    KATRM 

-l.OOCOCOOE  OO       -2.CC0CC0CE  OO       -2.0000000F  OO 
0.0  -l.CCOCCCCE  00        l.OCOOOOOF  00 

l.OOCOCOOE  00        0.0  -l.OOOOOOOF  00 

ThE  C  MATRIX 

l.OOCOCOOE  00        l.OOOCCOCE  00        0.0 

»»*♦*«»»•»»«»»*♦»«»»»»»♦»»*»»♦♦«♦♦♦**»**•»*»* 

QBSEhVABILITY    INCEX  3 


IHjfSVABTL IT  V     IMCE»    CAK.ULATICN 

PROBLEM    IOENTIFICATIC'1-  OBSERV    TEST    TWP 


TKE    A     "ATJUX 

2.0000C0JE    00 

0.0 

0.0 

l.CCOCCCCE 
2.CCCCCCCE 
0.0 

00 
00 

n.O 

l.OCOOOOOF 
2.0000000F 

00 
00 

THE    C    MATRIX 

0.0 

0.0 

l.CCCCCCCE 
2.CCCCC0CE 

00 
00 

3.0000000c 
4.0000000F 

00 
00 

IA.O     IS    UNCBSEPVAeLE 


Figure  3-18   Observability  Subprogram  Tests 
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M.   Next  the  A  matrix  (N  xN),  the  B  matrix  (L  x  N)  and  the 
C  matrix  (M x  N)  are  entered  one  row  at  a  time  using  an  8F10.4 
format. 


Entry    Input  Description 

1  Problem  identification, 
system  order  (N  <_  10)  , 
number  of  rows  of  BT(L  <_   10), 
number  of  outputs  Im.  <_   10) 

2  A  (N  x  n)  matrix  (one  row  per 
card  if  N  <_  8;  one  row  per 
two  cards  if  N  >  8) 

T 

3  B   (LxN)  matrix  (one  row 

per  card  if  N  <_  8;  one  row 
per  two  cards  if  N  >  8) 

4  C  (MxN)  matrix  (one  row 
per  card  if  N  <  8;  one 

row  per  two  cards  if  N  >  8) 


Format 

5A4, 
312 


8F10.4 


8F10.4 


8F10.4 


Columns  Used 

1-20,  21-22, 
23-24,  25-26 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


Table  XI  -  Input  Format  Table  for  CONOBS 

b .  Output 

The  problem  identification  and  all  three  matrices 
are  output  for  reference.   Then  two  sentences  are  printed 
indicating  whether  or  not  the  (A,C)  system  is  observable 
and  the  (A.,B)  system  is  controllable. 

c.  Example 

The  following  systems  are  to  be  tested  for  observa- 
bility and  controllability: 
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(1) 


x(t)   = 


-2 

0 

1 

0 

-1 

0 

-3 

-4 

-2 

x(t)  + 


0     1 

0  0 

1  0 


u(t) 


y(t)  = 


xx(t) 


(2) 


x(t) 


■2  0 
0  -1 
•3       0 


n 

1 

-2j 


x(t)  + 


lu    l 

0     0 


u(t) 


y(t)   =   Xl(t) 

Here  again,  both  solutions  are  obtained  in  a  single  run  using 
one  set  of  control  cards  before  the  two  consecutive  data 
decks. 
For  (1), 


-2 

.0 

1 

A(3  x  3)       = 

Q 

-1 

Q 

-3 

-4 

-2 

B  (2  x  3)  = 


0 

1 


Q 
0 


C(lx3)   =   [1 


0] 
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Thus  system  order  N 
number  of  outputs  M 
For  (2), 


3,  number  of  rows  of  B,L  =  2  and  the 
1. 


A(3  x  3)   = 


-2      0      1 

0-11 

-3       0      -2 


B(2  x  3)   = 


C(l  x  3)   =   [1 


0] 


and  the  system  is  of  order  N  =  3,  with  L  =  2  and  M  =  1 

The  control  cards  and  data  decks  are  then  as  follow: 

//  (standard  OS  JOB  card) 

/A  EXEC  ~LINCON 

//LINK . SYS IN  ^DD^ * 

«  ^INCLUDE  ~SYSLIB (CONOBS ) 

/* 

//GO.SYSIN-DD-* 

CONOBS  TEST  ONE  030201 

-2.0      0.0  1.0 

0.0       -1.0  0.0 

-3.0      -4.0  -2.0 

0.0       0.0  1.0 
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1.0 

0.0 

0.0 

1.0 

0.0 

0.0 

CONOBS 

TEST 

TWO 

030201 

-2.0 

0.0 

1.0 

0.0 

-1.0 

1.0 

-3.0 

0.0 

-2.0 

0.0 

0.0 

1.0 

1.0 

0.0 

0.0 

1.0 

0.0 

0.0 

/* 

The  results  are  presented  in  Fig.  3-19. 
3.   Sensitivity  Analysis  (SENSIT) 

This  subprogram  is  used  to  obtain  the  root  locus  of 
the  closed-loop  poles  of  the  (single-input  single  output) 
linear  control  system 

x(t)   =  A  x(t)  +  b  u(t) 

u(t)   =   G[r(t)  -  kTx(t)],   where  G  is  a  scalar, 

as  a  single  element  of  the  plant  matrix  A, or  the  control 

T 
vector  b,  or  the  feedback  coefficients  matrix  k  ,  or  the  con- 
troller gain  K  varies  between  some  specified  values.   As 
already  mentioned,  the  subprogram  studies  the  effect  of  a 
single  parameter  variation  and  plots  the  result.   If,  for 
the  same  system,  it  is  desired  to  consider  more  than  one 
parameter  variation  the  user  indicates  his  choices  by  providing 
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Figure  3-19   Controllability  and  Observability  Subprogram  Tests 
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one  option  card  per  element  to  be  varied  and  the  computer 
completes  one  root  locus  for  each  parameter.   The  end  of  a 
problem  is  indicated  by  a  blank  card.   After  that  card,  a 
data  deck  pertaining  to  other  systems  may  be  included  if 
desired. 

Execution  times  for  this  subprogram  are  normally  more 
than  20  seconds.   Thus  TIME  =  2  should  be  specified  on  the  JOB 
card.   Mode  One  or  Mode  Three  is  to  be  used  to  access  the 
subroutines. 

a.   Input 

The  problem  identification  and  the  system  order 

(N  <_  10)  are  presented  on  the  first  card.   Next  the  plant 

T 
matrix  A  (N  x N)  and  the  b   (1  x n)  matrix  are  entered,  followed 

by  the  feedback  coefficients  k,  ,  k0 ,  ...,  k  ,  and  the  controller 
J  1   2'     '   n 

gain  G.   Then  the  option  card  is  given,  indicating  the  element 
to  be  varied,  the  number  of  parameter  values  to  be  used,  and 
the  minimum  and  the  maximum  values  of  that  parameter.   This 
card,  with  the  proper  modification,  is  repeated  once  for  each 
element  to  be  varied.   Finally  a  blank  card  indicates  the  end 
of  the  problem. 


Ill 


Entry    Input  Description  Format 

1  Problem  identification, 
order  of  the  system  (N  _<  10) 

2  &  (N  x  n)  matrix  (one  row  per 
card  if  N  <  8;  one  row  per 
two  cards  if  N  >  8) 

T 

3  b   (1  x  n)  matrix  (one  card 

if  N  <  8;  on  two  cards  if 
N  >  8) 

T 

4  k   (1  xn)  coefficients  matrix 

(one  card  if  N  <  8;  two  cards 
if  N  >  8) 

5  Controller  gain  G 

6 
(repeat   (1)  element  to  be  varied 
this        (letter  A  if  the 
entry  once   element  is  part  of  A, 
for  each     letter  B  if  the 
parameter    element  is  part  of  b, 
which  is     K  if  the  element  is"* 
to  be       one  of  the  feedback 
varied)      coefficients,  G  if  the 

element  is  the 

controller  gain) 

(2)  row  number  of  the  element    12, 
if  from  A,  b,  or  k. 
Otherwise  set  equal  to 
00. 

(3)  column  number  of  the         12, 
element  if  from  A. 
Otherwise  set  equal 
to  00. 

(4)  number  of  parameter  values 
to  be  used. 

(5)  minimum  value  of  the 
parameter. 

(.6)  maximum  value  of  the 
parameter. 

7     blank  card  (this  indicates       (blank) 
the  end  of  the  problem) 


Columns  Used 


5A4 
12 

1-20, 

21-22 

8F10.3 

1-10, 
etc. 

11-20, 

8F10.3 

1-10, 
etc. 

11-20, 

8F10.3 

1-10, 
etc. 

11-20, 

8F10.3 

1-10 

Al 

1 

2-3 


4-5 


15, 

6-10 

F10.3, 

11-20 

F10.3 

21-30 

(blank) 


Table  XII  -  Input  Format  Table  for  SENSIT 
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The  user  must  be  very  careful  while  preparing  the 
option  cards.      The   following  example   can  best   illustrate   the 
procedure.      Suppose   it   is  desired  to  get  the   root   locus   of 
the  poles  of   a  closed-loop   system  as   the  parameter  a.~.   varies 
from  0.0   to   100.0.      A   "number  of  parameter  values   to  be  used" 
of   20   is   selected  giving  the   following  option   card: 

column     1  2  3  4  5  6  7  8  9  10  11  12  13  14  15  16  17  18  19  20  21  22  23  24 
data        A0204000200.0  100. 

If   for  the   same  problem,    it   is   also  desired  to   study   the 
variation  of   the   closed-loop  poles   as   b~   varies   from  0.0   to 
100.0  with  a    "number  of   parameter  values   to  be  used"    of   10   and 
also   as   G  varies    from  -1600.    to   -1200.    with   a    "number  of 
parameter  values   to  be   used"   of   25,    then   the    two  added  option 
cards  would   be: 

column     1  2  3  4  5  6  7  8  9  10  11  12  13  14  15  16  17  18  19  20  21  22  23  24  25  26 

data        B0300000100.0  100. 

data        G000000025-1600.  -1200. 

b.   Output 

T    T 
The  problem  identification,  the  A,  b  ,  k  matrices 

and  the  gain  value  G  are  listed  first.   Then  the  first  element 

to  be  varied  and  its  minimum  and  maximum  values  are  printed, 

followed  by  each  parameter  value  and  the  closed-loop  poles 

associated  with  it.   Finally  the  root  locus  plot  is  given  for 

each  element  to  be  varied. 
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Note  that  the  "number  of  parameter  values  to  be 
used"  should  be  kept  small.   Since  the  values  of  the  roots 
are  calculated  and  printed  for  each  parameter  value,  100 
values  should  be  regarded  as  a  practical  maximum, 
c.   Example 

The  stability  of  the  following  system  is  to  be 
investigated  under  gain  variation  and  the  effect  of  the  non- 
perfect  integrator  (— — )  looked  at. 


T(t)  + 


s 

>i 

2C,(t) 

-\  JTT^t)  s 

1 
s  +  1 

1 

s  +  2 

1 

S  +  £ 

1 

i  >Lj     > 

s 

v 

Fig  3-20    Control  System  for  SENSIT  Test 


First  the  state  equations 


x1(t)   =   -ex^t)  +  x2(t) 


x2(t)   =   -2x2(t)  +  x3(t) 


x3(t)   =   -x3(t)  +  u(t) 


u(t)   =   G[r(t)  -  x1(t)] 


are  written,  giving  the  following  data: 
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Order  of  the  system:   N  =  3 


A  = 


— 

-e 

l 

0 

0 

-2 

1 

J) 

0 

-1. 

CO 

0 

1] 

[l 

0 

0] 

The  gain  G  is  to  be  varied  from  0  to  10  with  e  set  to  zero, 

and  a  "number  of  values  to  be  used"  of  20  seems  reasonable. 

The  value  of  z    is  also  to  be  varied  with  G  set  to  its  nominal 

value  of  1.0.   First  e  is  set  equal  to  zero  in  the  A  matrix. 

A  range  of  variation  of  0  to  1  and  a  "number  of  values  to  be 

used"  of  25  are  selected. 

The  control  and  data  cards  are: 

//  (standard  OS  JOB  card) , TIME=2 

/AEXEC^LINCON 

//LINK.SYSIN^DD^* 

~INCLUDE~SYSLIB  (SENSIT) 

/* 

//GO.SYSIN^DD^* 

SENSIT  TEST  03 

0.0       1.0  0.0 

0.0       -2.0  1.0 

0.0       0.0  -1.0 
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0.0  0.0  1.0 
1.0  0.0  0.0 
1.0 

G0000000200.0    10.0 
A010100025   0.0   1.0 
(blank  card) 

/* 

The  results  are  presented  in  Fig.  3-20 (A-D) . 

4.   State  Variable  Feedback  (STVAR) 

This  subprogram  is  a  very  powerful  aid  for  design  and 
analysis  of  any  single-input  single-output  linear,  time- 
invariant  system  represented  by  the  states  equations 

x(t)   =  A  x(t)  +  b  u(t) 
u(t)   =   K[r(t)  -  kT  x(t)l 
v(t)   =   c  x(t) 


It  permits  one  to  find  internal  transfer  functions 

of  the  form  X.(s)/U(s),  the  plant  transfer  function  Y(s)/U(s), 

the  closed-loop  transfer  function  Y(s)/R(s)  and  the  equivalent 

feedback  transfer  function  H   (s) .   In  addition,  this  subpro- 

eq  F 

gram  calculates  the  controller  gain  and  the  feedback  coeffi- 
cients necessary  to  achieve  a  specified  closed-loop  transfer 
function.   It  is  to  be  run  as  a  Class  A  job  and  is  accessible 
under  Mode  One  or  Mode  Three. 
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Figure    3-20A      Sensitivity  Analysis   -  Variation  of  Gain 
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Figure    3-20C      Sensitivity  Analysis   -  Variation  of  A (1,1) 
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The   procedure   is   not  very   complex,   but 
requires  understanding.    All   the   information   needed  by 
the  user  to  solve  state  variable  feedback  problems  is 
presented  in  the  following  paragraphs.   However,  the  theory  on 
which  the  subprogram  is  based  is  not  given.   The  user  who 
wishes  to  learn  more  about  it  should  refer  to  the  texts  by 
Schultz  and  Melsa  [5] ,  Melsa  and  Jones  [1] ,  Eveleigh  [6]  or 
others . 

a.   Input 

(1)   Basic  Cards 

As  usual  the  problem  identification  and  the 
system  order  are  given  on  the  first  data  card,  followed  by 

the  plant  matrix  A  (N  *  N)  and  the  transpose  control  vectors 

T 
b   (1  x  N)  .   From  this  input  (which  is  always  required)  the 

subprogram  verifies  the  controllability  of  the  system.   Three 
possible  controllability  conditions  may  be  found  by  the 
computer.   One,  the  system  is  completely  controllable  and  no 
special  message  is  printed.   Two,  the  system  is  numerically 
uncontrollable.   In  other  words,  it  is  theoretically  controlla- 
ble but  uncontrollable  in  a  numerical  sense.   This  situation 
arises  when  the  controllability  matrix 


E   =   [B   AB   AB2   . . .   ABn   ] 


cannot  be   accurately   inverted  using  the  programmed  algorithm 
The  matrix  and  its  calculated  inverse  are  then  multiplied 
together  and  checked  against  the  identity  matrix  to  provide  a 
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measure  of  the  uncontrollability  of  the  plant.   If  the  des- 
cribed condition  occurs,  the  message  "plant  is  numerically 
uncontrollable"  is  given  accompanied  by  "MAX.  DEVIATION=number" , 
where  "number"  is  the  value  of  the  deviation  from  the  identity 

matrix.   Reference  1  states  that  a  maximum  deviation  value 

-3      -5 

larger  than  10   to  10   has  been  found  to  indicate  diffi- 
culty.  The  last  controllability  condition  is  "the  system  is 
uncontrollable",  and  is  indicated  as  such.   Note  that  even  if 
the  plant  is  determined  to  be  uncontrollable,  the  computer 
solves  the  problem  and  presents  the  results.   The  option  of 
accepting  or  rejecting  the  solution  is  the  designer's  preroga- 
tive. 

(2)   Open-Loop  Cards 

The  next  input  cards  specify  which  open-loop 
transfer  functions  are  to  be  computed.   These  cards  need  not 
be  provided  if  no  internal  transfer  function  is  desired.   The 
way  to  identify  the  internal  transfer  functions  to  be  output 
is  by  using  ficticious  cf  matrices.   The  following  example 
demonstrates  the  procedure.   Suppose  the  internal  transfer 
functions  X  (s)/U(s)  and  X..(s)/X.  (s)  are  desired  for  a  fourth 
order  system.   Since  only  X.(s)/U(s)  type  of  transfer  functions 
are  computed  by  the  subprogram,  X.(s)/U(s),  X  (s)/U(s)  and 
X.(s)/U(s)  are  requested  and  the  user  then  only  needs  to 
divide  X,(s)/U(s)  by  X4(s)/U(s)  to  obtain  X1(s)/X4(s).   The 
fictitious  cf  matrices  to  be  provided  as  input  are  then: 
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X,  (S) 
(1)   for 


U(s)  ' 


cf   =   [1    0    0    0] 


X2(8) 


(2)  for  uTiT' 


cf   =   [0    1    0    0] 


X  (s) 
(3)   for 


U(s)  ' 


cf   =   [0    0    0    1] 


Following  these  cards,  the  real  output  matrix  c  and  a  null 

matrix  0  (1 x N)  must  be  entered.   The  real  c  matrix  is  used 

Y  (s) 

to  compute   ,  »  and  correctly  solve  the  rest  of  the  problem. 

The  0  matrix  is  necessary  to  indicate  the  end  of  open-loop 
calculations. 

(3)   Closed-Loop  Cards 

Finally  the  closed-loop  input  data  are  given. 
Here  again  the  user  has  a  choice  among  three  options. 

The  first  of  these  closed-loop  computations 
is  for  analysis  only.  This  choice  is  indicated  by  an  option 
card  on  which  the  letter  A  is  printed  in  column  one.   Following 

this  card,  the  feedforward  gain  K  and  the  feedback  coefficient 

T 

matrix  k  are  given  as  specified  on  the  input  format  table. 

From  this  input,  the  subprogram  determines  the  closed-loop 
characteristic  polynomial  and  the  numerator  of  the  equivalent 
feedback  transfer  function  (both  the  factored  and  unfactored 
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forms)  .    From  these,  the  block  diagram  shown  in  Fig.  3-21 

can  be  drawn  where  G  (s)  =  Y(s)/U(s)  and  H   (s)  is  the 

P  eq 

equivalent  feedback  transfer  function. 


R(s)  + 


s> 


U(s) 


G  (s) 


Heq(s> 


->Y(s) 


Fig  3-21   H   Form  Block  Diagram 

The  other  two  closed-  loop   computations  are 
for  design  purposes.    They  are  used  to  calculate 
the  controller  gain  and  the  feedback  coefficients  necessary 
to  achieve  a  given  closed- loop  characteristic  polynomial. 
This  desired  polynomial  is  the  denominator  of  Y(s)/R(s)  and 
must  agree  with  the  system  order.   If  the  characteristic 
polynomial  is  to  be  entered  in  P  form,  an  option  card  with 
the  letter  P  in  column  one  is  presented  followed  by  one  (if 
n  <  8)  or  two  (if  n  >  8)  cards  containing  the  coefficients  in 
ascending  order.   The  coefficient  of  the  highest  degree  term 
must  always  be  1.0  and  may  be  entered  as  ten  blank  spaces. 
On  the  other  hand,  if  it  is  more  convenient  to  present  it  in 
factored  form,  the  option  card  has  the  letter  F  in  the  first 
column  and  the  next  cards  give  the  real  and  imaginary  parts 
of  the  root  using  a  2E10.0  format. 
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Since  a  user  may  very  well  wish  to  obtain 
the  closed- loop  computations  for  many  different  characteristic 
polynomials  or  try  out  several  values  of  feedback  or  feed- 
forward gains,  the  subprogram  allows  one  to  ask  for  as  many 
closed-loop  computations  as  desired  by  placing  the  input 
cards  one  on  top  of  the  other. 

(4)   Problem  Termination  Card 

The  last  card  must  be  blank.   It  indicates 
the  end  of  the  problem  and  must  always  be  present,  whether 
or  not  the  closed-loop  portion  is  included.   The  following 
format  table  conveniently  summarizes  all  the  above. 

Entry    Input  Description  Format    Columns  Used 

1  Problem  identification,         5A4 ,  12    1-20,  21-22 
(Basic)  system  order  (N    10) 

2  Plant  matrix  A  (N x N)  (one      8E10.0     1-10,  11-20, 
(Basic)  row  per  card  for  N  _<  8;  one  etc. 

row  per  two  cards  for  N  >  8) 

3  Control  vector  bT  (1 x N)         8E10.0     1-10,  11-20, 
(Basic)  (one  card  for  N~£  8;  two  etc. 

cards  for  N  >  8) 

4  cf  (lxN)  (one  card  for         8E10.0     1-10,  11-20, 
(open-   N  <  8;  two  cards  for  N  >  8)  etc. 

loop)    (repeat  if  several  fictitious 
matrices) 

5  Output  matrix  c  (1 x N)  (one     8E10.0     1-10,  11-20, 
(open-   card  for  N  £  8;  two  cards  etc. 

loop)    for  N  >  8) 

6  Null  matrix  0  (1 x N)  (one       8E10.0    all 
(end  of  blank  card  for  N  <_   8;  two 

open-   blank  cards  for  N  >  8) 

loop 

part) 
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Input  Description 
Letter  A  in  column  one 

Feedforward  gain 


Feedback  coefficient  matrix 
kT  (1  x  N)  (on  one  card  for 
N  <_  8;  two  cards  for  N  >  8) 

Letter  P  in  column  1 


Entry 

7 
Analy- 
sis 

8 
Analy- 
sis 


Analy- 
sis 

10 
Design 
option; 
unfactored 

form 

11 
Design 
option; 
unfac- 
tored 

form 

12 
Design 
option; 
factored 
form 


13  Desired  characteristic  poly- 
Design  nomial  roots  (one  per  card, 
option;  real  part  followed  by 
factored  imaginary  part.   See  p.  (32) 

form  for  details 


14 


Desired  characteristic  poly- 
nomial coefficients  (one  one 
card  if  N  <  8;  two  cards  if 
N  >  8)  .   See  p.  (31  )  for 
details 


Letter  F  in  column  1 


Format 
Al 

8E10.0 

8E10.0 

Al 


8E10.0 


Al 


8E10.0 


8E10.0 


Columns  Used 
1 

1-10 


1-10,  11-20, 
etc. 


1-10,  11-20, 
etc. 


1-10,  11-20. 


blank 


Blank  card  (indicates  the 
end  of  this  problem) 

Table  XIII  -  Input  Format  Table  for  STVAR 
Note  that  entry  (4)  must  be  included  if  no  internal  transfer 

function  is  desired.   The  same  also  applies  to  entries  (7-8-9) 

if  analysis  option  is  not  desired  and  (10-11)  and/or  (12-13) 

if  no  design  option  is  taken. 

b .   Output 

T 
The  problem  identification  and  the  A  and  b 

matrices  are  given  and,  if  applicable,  a  numerically  or 
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completely  uncontrollable  situation  is  indicated.   Next  the 
open-loop  calculations  are  presented.   The  denominator 
coefficients  in  ascending  powers  of  s  and  the  roots  of  the 
denominator  polynomial  are  listed  at  the  beginning  of  the 
section.   Then,  if  requested,  each  ficticious  cf  matrix 
followed  by  the  numerator  of  the  corresponding  transfer  func- 
tion is  printed.   The  last  output  of  this  section  is  the  c 
matrix  and  the  numerator  of  the  plant  transfer  function. 
The  user  is  reminded  that  the  ficticious  c-  matrices  indi- 
cate which  X.(s)/U(s)  is  computed  while  the  c  matrix  specifies 
the  real  output  y(t)  which  is  used  to  calculate  Y(s)/U(s). 
The  last  section  of  the  printout  concerns  the 
closed- loop  calculations.   If  the  analysis  mode  was  selected, 
"KEY=A"  is  printed  followed  by  the  numerator  of  the  equiva- 
lent feedback  transfer  function,  H   (s) ,  both  in  factored  and 

eq 

unfactored  forms.   Note  that  the  complete  H   (s)  is  obtained 
by  taking  the  "numerator  of  H   "  (given  in  the  closed-loop 
calculations)  and  dividing  it  by  the  numerator  associated  with 
the  real  c  matrix  (given  as  the  last  part  of  the  open-loop 
calculations) .   Next  the  feedback  coefficients  and  the  gain 
are  listed  for  reference  and  the  computed  closed-loop  char- 
acteristic polynomial  and  its  roots  are  given. 

If  computations  of  the  feedback  coefficients  and 
the  feedforward  gain  to  achieve  a  desired  closed-loop  char- 
acteristic polynomial  was  requested,  the  computer  output 
shows  "KEY=P"  or  "KEY=F" ,  depending  on  the  design  mode 
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selected.   Then,  as  for  the  analysis  mode,  the  numerator  of 

the  H   (s)  is  given,  followed  by  the  feedback  coefficient 

T 
matrix  k   and  the  feedforward  gain  K.   Here  it  must  be  pointed 

out  that  the  subprogram  calculates  the  gain  K  so  zero  steady- 
state  error  results  from  a  step  input.  A  designer  who  wishes 
other  conditions  may  rescale  K  and  k  appropriately  by  hand. 
For  example,  suppose  it  is  desired  to  have  the  controller 
gain  K  =  K^  but  the  computer  output  shows  that  K  =  Kn  with 
the  feedback  coefficients  k_ ,  k2  and  k  .   The  procedure  is 
then  to  modify  the  results  by  setting 


K   =   Kx 


and  setting 


T     K0 
~    "   K^[kl    k2    k3] 


This  does  not  change  Y(s)/R(s)  and  satisfies  the  condition 
K  =  K,.   Finally  a  parameter  called  "maximum  normalized 
error"  is  associated  with  each  closed-loop  calculation.   The 
value  of  this  parameter  indicates  the  exactitude  with  which 
the  problem  was  solved  by  the  computer.   This  number  can  help 
to  determine  the  validity  of  a  solution,  especially  when 
numerical  uncontrollability  was  encountered  to  start  with, 
c.   Example 

Eveleigh  [6]  presents  the  ideas  of  design  of 
control  systems  using  state-variable  feedback  and  works  out 
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two  examples,  the  first  of  which  is  solved  here  by  the 
computer  method  described  previously.   The  problem  can  be 
stated  as  follows:   given  the  plant  transfer  function 


G  (8) 


10 


s(s  +  1)  (s  +  3) 


find  each  state  feedback  gain  and  the  feedforward  path  gain 
necessary  to  achieve  the  closed  loop  transfer  function, 


G(s)   = 


10 


3     2 

s  +  4s  +  9s  +  10 


The  first  step  of  the  procedure  is  to  get  the 
state  variable  representation  of  the  system.   The  following 
signal  flow  graph  may  be  obtained: 


U(s) 


O  y(s) 


Fig  3-22   Signal  Flow  Graph  for  STVAR  Test 


By  inspection, 


A  = 


0  10" 
0-12 
0       0-3 
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bT   =   [0     0     5] 


c  =   [1    0    0] 

Normally  the  user  first  runs  the  subprogram  for 
open-loop  calculations.   Then  he  either  uses  it  for  analysis 
or  for  design.   To  illustrate  all  the  possibilities,  the 
subprogram  was  applied  to  solve  the  same  problem  using  all 
of  the  different  modes. 

(1)   Open-Loop  Test 

For  the  case  at  hand,  assume  the  solution  is 
to  include  the  internal  transfer  function  X_(s)/U(s).   Thus 
the  input  data  requires  a  ficticious  cf  matrix  to  be  added, 
i.e. 


cf  =   [0    1    0] 


The  computer  card  deck  for  this  simple 
open- loop  test  is: 
//.( standard  OS  JOB  card) 
/AEXEC^LINCON 
//LINK.SYSIN.DD.* 
~  .  INCLUDE .SYS LIB (STVAR) 

/* 

//GO. SYS IN .DD.* 

STVAR  OPEN  LOOP  TEST   03 
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0.0 

1.0 

0.0 

0.0 

-1.0 

2.0 

0.0 

0.0 

-3.0 

0.0 

0.0 

5.0 

0.0 

1.0 

0.0 

1.0 

0.0 

0.0 

(blank 

card) 

(blank 

card) 

/• 

The  first  blank  card  is  a  null  matrix  0  (1 x  3) 
that  indicates  the  end  of  open-loop  calculations  while  the 
second  blank  card  indicates  the  end  of  the  problem.   From 
the  results  shown  in  Fig.  3-23, 

X2(S)         10s  10 


U(s)      s(s+l)(s  +  3)      (s  +  l)(s  +  3) 


and 


Y(s)  10 


U(s)      s(s  +  1)  (s  +  3) 

(2)   Analysis  Test 

To  illustrate  the  analysis  computations,  the 
feedforward  gain  K  =  1  and  the  feedback  coefficients  k,  =  1, 
k9  =  0.6  and  k  =  0  were  assumed.  Again  the  computer  card 
deck  is  given  below. 
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STAT?    VARIABLE    e=ECBACK 

PKCHLEM    IDENTIFICATION   -  STVAP    OPFN-LHOP    TEST 

••»•**»«»*»«»*»**•*»«***«**»**«***»*<■*«««**♦« 

THF    A    MATRIX 

0.0  l.COOOCOOE    00  0.0 

0.0  -l.OOOOOOOE    00  2.0000000E    00 

CO  0.0  -3.0000000E   00 

THE    B    MATR IX 

0.0  0.0  5.0000000E  00 

•*»***•»«**•««*»*»*«»»•»»»««**#**•»»******♦** 

OPEN-LOOP    CALCULATIONS 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENOING    POWERS    OF    S 

0.0  3.00OOU00E    00  *.0OOO000F    00  l.OOOOOOOE    00 

THE    ROOTS    ARE  REAL    PART  IMAGINARY    PART 

-l.CCOOOOOE  00  .0.0 

-3.0000000E  00  0.0 

C.C  0.0 

1 

THE    C    MATRIX  «*»•« 

0.0  l.OOOOOOOE    00  ,         0.0 

NUMERATOR    COEFFICIENTS   -    IN    ASCENOING    POWERS   OF    S 

0.0  l.OOOOOOOE    01 

THE    ROOTS    ARE  RE*L    PART  IMAGINARY    PART 

CO  0.0 

THE    C    MATRIX  *•**• 

l.OOOOOOOE    00  0.0  0.0 

NUMERATOR    COEFFICIENTS    -    IN    ASCENOING    POWERS    OF    S 

l.OOOOOOOE    01 


Figure  3-23   State  Variable  Feedback  -  Open-Loop  Test 
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//  (standard  OS  JOB  card) 

//^  EXEQ,  LINCON 

//LINK. SYS IN ^DD^* 

m    „   INCLUDE  SYSLIB(STVAR) 

/* 

//GO.SYSIN  DD  * 

STVAR  ANALYSIS  TEST  03 

0.0 
2.0 
-3.0 
5.0 
0.0 


0.0 

1.0 

0.0 

-1.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

(blank 

card) 

A 

1.0 

1.0 

0.6 

(blank 

card) 

/* 

0.0 


Interpretation  of  the  output  reproduced  in 


Fig  3-24  gives 


Heq(s>   -  iTS-S£  ■  1  +  -6s 


and  shows  that  the  closed-loop  poles  are  at  -2  and  -1  ±  j2. 
(3)   Closed- Loop  Test 

Here  the  subprogram  is  used  for  design. 
Suppose  that  the  feedforward  gain  and  the  feedback  coefficient 
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STATE  VARIABLE  FEEDBACK 

PROBLEM  IDENTIFICATION  -       STVAR  ANALYSIS  TEST 

**»•••»»»•«»**»*»*»****■»•»•**»*»*»»»******»* 

THE  A  MATRIX  . 

0.0  1.C0000006    00  0.0 

0.0  -l.OCOCCOCE    00  2.0000000E    00 

0.0  0.0  -3.0000000E   00 

the  s  matrix 

0.0  0.0  5.0000000E  00 

********************* ******* »»*»»»»»»* ******* 

OPEN-LOGP    CALCULATIONS 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 

0.0  3.OC0C0OCE    00  4.0000000E    00  l.COOOOOOE    00 

THE    ROOTS    ARE  REAL    PART  IMAGINARY    PART 

-l.COOOOOOF.     00  0.0 

-3.0000000E  00  0.0 

0.0  0.0 

the  c  matrix  •  •*** 

l.OOOOOOOE    00  0.0  0.0 

NUMERATOR    COEFFICIENTS    -    IN    ASCENOING   POWERS   OF    S 

l.OOOOOOOE    01 
I******************************************** 
CLOSEO-LUOP    CALCULATIONS 
KEY    *    A         *»*«* 
THE    NUMERATOR    JF    I— EUUIVALENT    -    I'i    ASCENCING   POWERS    OF    S 

l.OOOOOOOE    01  5.999S990E    00  0.0 

THE    ROOTS    ARE  REAL    PAPT  IMAGINARY    PART 

-l.o66t>660E    00  0.0 

THE    FEeOdACK    COEFFICIENTS 

l.OOOOOOOE    00  5.9999S96E-01  0.0 

THE    GAIN   *         l.OOOOOOUE    00 
THE    CLOSED-LOOP    CHARACTER  1ST IC    PrLYNOMTAL   -    IN    ASCENDING    POWERS    OF    S 

l.OOOUOOOE    OL  d.99S9961E    00  4.0COOOOOE    00  l.OOOOOOOE    00 

THE    ROOTS    ARE  RF«L    PART  IMAGINARY    PART 

-l.CCOOOOOF  00  -2.0000000E    00 

-1.0000000c  00  2.0000000E    00 

-2.0000000E  00  0.0 

MAXIMUM    N3RMALUED    ERROf     *       1.06F-07 


Figure  3-24   State  Variable  Feedback  -  Analysis  Test 
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values  are  to  be  obtained  so  the  closed- loop  characteristic 

3    2 

polynomial  is  s  + 4s  + 9s +  10  or,  equivalently ,  the  closed- 
loop  poles  are  located  at  -2  and  -1 ± j2.   For  illustration, 
calculations  are  requested  for  both  the  P  and  the  F  forms 
(even  though  they  are  exactly  the  same)  .  The  control  cards 
and  data  deck  are  then: 
//  (standard  OS  JOB  card) 
/AEXEC.LINCON 
//LINK.SYSIN^DD^* 
„  ^   INCLUDE ^SYSLIB(STVAR) 

/* 

//GO.  SYS  IN  JDD^* 

CLOSED  LOOP  TEST   03 

0.0       1.0       0.0 

0.0      -1.0       2.0 

0.0       0.0      -3.0 

0.0       0.0       5.0 

1.0       0.0       0.0 

(blank  card) 

F 

1.0       2.0 

2.0 

P 

10.0      9.0       4.0       1.0 

(blank  card) 

/* 
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As  expected,  the  results  shown  in  Fig  3-25 
specify  a  gain  of  one  and  feedback  coefficients  values  of 
k,  =  1.0,  k2  =  0.6  and  k.  =  0.0. 

Note  that  all  the  above  calculations  could 
have  been  executed  as  a  single  run  using  the  following  card 
deck: 

//  (standard  OS  JOB  card) 
/AEXECJLINCON 
//LINK. SYS IN ^DD^* 
„  A   INCLUDE  SYSLIB(STVAR) 

/* 

//GO. SYS IN ^DD^* 


STVAR  TEST 

03 

0.0 

1.0 

0.0 

0.0 

-1.0 

2.0 

0.0 

0.0 

-3.0 

0.0 

0.0 

5.0 

0.0 

1.0 

0.0 

1.0 

0.0 

0.0 

(blank 

card) 

F 

2.0 

1.0 

2.0 

A 

1.0 

1.0 

0.6 

0.0 

(blank 

card) 

/* 
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STA1F    VAklAbLE    FEECbAtK 

PROBLEM    IDENTIFICATION   -  CLOSFO-LOOP  TEST 

•••  •••»■»»«■•»»»*•»»»**•»»*»»»*»«»•*«-»«*«*#*♦ 

THE    A    MATRIX 

0.0  l.OCOOOCCE    00  0.0 

0.0  -l.OOOOOOOE    00  2.0000000F    00 

O.J  0.0  -3.000")000F    00 

THE    b    -ATC  IX 
0.0  0.0  5.0000000E    00 

OPFN-LOCP    CALCULATES  \ 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENOING    POWERS    OF    S 

0.0  3.O0O00U0E   00  4.0000000E   00  l.OOOOOOOE    00 

THE    ROOTS    ARE  REAL    <»ART  IMAGINARY    PART 

-l.OCJOOOUF    00  0.0 

-3.0000000E    00  0.0 

0.0  0.0 

TMF    C    MATRIX  ***•* 

l.OOOOOOOE    00  0.0  0.0 

NU^RATCR    COEFFICIENTS   -    IN    ASCENDING    POWERS    OF    S 

l.OOOOOOOE    01 

closed-loop  calculations 

KEY    »    F  •  »*«• 

THE    NUMERATOR    OF    H-EQUlVALENT    -    \V    ASCENDING    POWERS    OF    S 

l.OOOOOOOE    01  6.0000019E    00  0.0 

THE    ROOTS    ARE  FEAL    PART  IMAGINARY    PART 

-1.6666660F     00  0.0 

THE   FEEMACK    COEFFICIENTS 

l.OOOOOOOE    00  6.0C0CCC2E-01  0.0 

THE   GAIN    »         9.9999J53E-01 
THE    CLOSEO-LOOP   CHARACTERISTIC    PCLYN3MIAL    -    IN    ASCENOI.NG    POWERS    OF  S 

9.9999962E    00  8.9999962S    00  <.. 00300005    00  l.OOOOOOOE    00 

THE   ROOTS   ARE                                    PE4L    PART  IMAGINARY    PART 

-l.OCOCOOl?  00  -1.9999990F    00 

-l.OOOOOOOE  00  1.9999990E    00 

-i.CCOCOOO?  00  0.0 

MAXIMUM    NORMALIZED    ER"CP    «       3.1SE-07 

KEY    »    P  •»**» 

THE    NUMERATOR    OF    H-ECUIV AL ENT    -    IN    ASCENDING    POWERS    OF    S 

1.000300*E    01  6.000CC1SE    00  0.0 

THt    PCOTS    AFE  REAL    P*OT  IMAGINARY    PART 

-1.66O6660E    00  0.0 

THE    FEE03ACK    COEFFICIENTS 

l.OOCOOOOF    00  6.0000002E-01  0.0 

THE    GAIN   «         9.9999956E-GI  

THE    CLOSED-LOOP    CHARACTERISTIC    POLYNOMIAL    -    IN    ASCENOING    POWERS    OF    S 

9.9999962E    00  8.9999S62E    00  4.0C0O00OF    00  l.OOOOOOOE    00 

THE    ROOTS    ARE  REAL    P4FT  I-AGINARY    PART 

-l.CCOOOOOE  00  -1.9999990E    00 

-1.0000000=  00  1.9999990E    00 

-2.00000005  00  0.0 

MAXIMUM    NORMALIZED    ERROR     -      3.18E-07 


Figure  3-25   State  Variable  Feedback  -  Closed-Loop  Test 
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(4)   Step  Procedure 

The  procedure  demonstrated  through  this 
simple  example  applies  for  all  problems.   The  steps  to  be 
taken  can  be  summarized  as  follows: 

(a)  Obtain  the  state  variable  representa- 
tion of  the  system. 

T 

(b)  get  A,  b  ,  and  c. 

(c)  If  necessary,  define  ficticious  cf 
matrices  to  compute  "internal"  transfer  functions. 

(d)  For  analysis,  select  the  feedforward 

gain  K  and  the  feedback  coefficients  k, ,  k0 ,  .  ..,  k  . 

i   2.  n 

(e)  For  design,  select  the  desired  closed- 
loop  characteristic  polynomial  or  poles  to  be  achieved. 

5.   Luenberger  Observers  (LUEN) 

The  subprogram  LUEN  is  used  to  design  a  combined 
observer-controller  to  achieve  a  desired  closed-loop  transfer 
function  when  some  of  the  states  are  not  accessible.   The 
following  paragraphs  present  a  detailed  description  of  the 
computer  aided  design  procedure.   However  the  theory  of 
Luenberger  Observers  in  the  design  of  linear,  time-invariant 
feedback  control  is  not  included  in  the  discussion.   Users 
who  are  not  familiar  with  the  subject  should  consult  refer- 
ences 4  and  7,  or  any  other  relevant  textbook  before  working 
with  this  subprogram. 

The  solution  plan  is  to  start  from  the  state  variable 
representation  of  a  linear  time-invariant  system  and  recon- 
struct the  missing  states  using  an  observer.   Then,  using 
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both  measured  and  estimated  states,  assign  the  feedback 
coefficients  and  gains  required  to  properly  control  the 
system.   The  block  diagram  presented  in  Fig  3-26  best  shows 
what  is  meant.   The  plant  represented  by  the  state  variable 
equations 

x(t)   =  A  x(t)  +  b  u(t) 

y(t)   =  C  x(t) 

must  be  controllable  and  observable.   Notice  that  the  C 
matrix  indicates  which  state  variables  are  measured.   For 
example,  a  fourth  order  system  with  only  the  states  x? 
and  x^  being  accessible  would  yield 


C   = 


1    o    ol 

0      1      OJ 


The  real  output  to  be  controlled,  denoted  by  y  (t) ,  may 
either  be  one  of  the  state  variables  or  a  linear  combination 
of  several  of  them.   The  user  is  to  define  a  desired  closed- 
loop  transfer  function  and  find  what  feedback  gains  would 
normally  have  to  be  used  to  obtain  it,  assuming  all  states 
were  available.   This  is  done  using  the  subprogram  STVAR 
as  explained  later  in  the  design  procedure. 

The  subprogram  LUEN  is  then  used  to  calculate  all 
the  elements  necessary  to  construct  the  observer  and  the 
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CONTROLLER 


u(t) 


PLANT 


t> 


yc(t) 


iMEASUREMENT 


OBSERVER 


c 


y(t) 


Fig  3-26   Luenberger  Observer  Block  Diagram 
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controller.   The  designer  only  has  to  specify,  in  an  arbi- 
trary  manner,  the  observer  eigenvalues  and  the  necessary 
feedback  coefficients  previously  found  by  the  use  of  STVAR. 
The  computer  solution  gives  all  the  matrices  and  gains 
required.   Brought  together  these  form  the  following  compen- 
sated system: 

x(t)   =   A  x(t)  +  b  u(t) 


x(t)   =   F  x(t)  +  G   y(t)  +  G   u(t) 


u(t)   =  K[r(t)  -  gTy(t)  -  hTx(t)] 


where 


y(t)   -   C  x(t) 


x(t)  =  state  vector 

u(t)  =  input  to  the  plant 

y(t)  =  output  vector 

r(t)  =  system  forcing  input 

A, 

x(t)  =  estimated  state  vector 

A  =  plant  matrix  (N  x  N) 

B  =  distribution  matrix  (N  x 1) 
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F      =   observer  eigenvalue  matrix 
G, ,G_   =   observer  gain  matrices 
K      =   controller  gain 


T 
g      =   output  feedback  coefficient  matrix 


T 
h      =   observer  feedback  coefficient  matrix 


C      =   output  matrix. 

All  these  elements  except  for  K,  which  comes  from  STVAR 

results ,  are  given  as  output  of  the  subprogram  LUEN.   The 

four  equations  defining  the  compensated  system  can  be  easily 

rearranged,  as  demonstrated  in  the  example  which  follows, 

to  simulate  the  system  by  the  use  of  the  subprogram  GTRESP. 

a.   Design  Procedure 

The  step-by-step  design  procedure  presented  here 

contains  the  essential  information  to  use  the  program.   It 

also  summarizes  the  Luenberger  Observers  design  concepts. 

Step  1 

The  closed- loop  transfer  function  Y  (s)/R(s)  to  be  achieved 

c 

must  be  selected  and,  assuming  all  states  to  be  measured,  we 

solve  for  the  controller  gain  K  and  the  feedback  coefficients 

kn ,  k_,  ...,  k  .   This  is  done  using  the  state  variable 
±        z  n 

feedback  subprogram  STVAR,  which  also  checks  for  system 
controllability.   It  must  be  kept  in  mind  that  the  c  matrix 
for  STVAR  is  the  matrix  associated  with  the  real  output  y  (t) 
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Step  2 
If  an  acceptable  solution  resulted  from  STVAR,  the  observa- 
bility index  must  next  be  determined.   This  can  be  done  by 
the  use  of  the  subprogram  OBSERV,  or  by  hand,  using 


G   =   [CT   ATCT   (AT)2CT   ...   (AW] 


where  the  observability  index  r  is  the  minimum  integer  such 
that  the  matrix  G  has  rank  r.   If  (A,C)  is  found  to  be 
observable,  an  observer  whose  order  is  equal  to  or  greater 
than  (r-1)  can  be  designed. 

Step  3 
The  eigenvalues  of  the  observer  are  selected  arbitrarily. 
However/  to  ensure  a  unique  solution  will  exist,  it  is 
necessary  to  let  the  eigenvalues  of  F  be  different  from  those 
of  A.   The  eigenvalues  of  A  were  previously  calculated  by 
STVAR  so  it  should  be  very  easy  to  choose  some  appropriate 
roots  for  the  observer. 

Step  4 
Using  the  input  format  for  LUEN,  the  data  are  entered  and  the 
subprogram  executed.   The  following  system  is  the  final 
result: 

x(t)   =  A  x(t)  +  b  u(t) 

y(t)   =   C  x(t) 
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*(t)   =   F  x(t)  +  G1  y(t)  +  G2  u(t) 


u(t)   =  K(r(t)  -  gTy(t)  -  hTx(t)) 


Step  5 
If  desired,  the  above  equations  are  rearranged  using  simple, 
although  sometimes  laborious,  matrix  manipulation  as 


x(t) 
x(t) 


=   A 


X(tJ| 

x(t) 


+  b  r(t) 


Xc{t)      =   S 


x(tfl 
x(t) 


Note  that  the  above  augmented  system  order  is  equal  to  the 
order  of  the  plant,  N,  plus  the  order  of  the  observer.   The 

complete  system  is  finally  simulated  by  the  use  of  GTRESP 

T 

letting  k   equal  zero  and  K  equal  to  unity. 

b.   Input 

As  usual  the  data  deck  begins  with  the  problem 
identification  card  on  which  the  order  of  the  plant,  N,  the 
number  of  measurements  M  and  the  order  of  the  observer,  (r-1) 

or  greater,  also  appears.   Next,  the  plant  matrix  A  (N x N) , 

T 
the  distribution  vector  b   (1  *  N)  and  the  measured  states 

matrix  C  (M  x N)  are  given  one  row  at  a  time.   The  feedback 

T 

coefficient  matrix  k   is  then  entered  exactly  as  given  by 
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the  state  variable  feedback  subprogram  (STVAR)  output. 
Finally/  the  observer  eigenvalues,  which  are  different  from 
those  of  the  plant,  are  supplied  either  in  the  form  of  a 
characteristic  polynomial,  option  P,  or  as  the  roots  of  that 
polynomial,  option  F.   The  option  is  specified  in  column  one 
of  the  first  card  by  writing  the  letter  P  or  the  letter  F. 
If  option  P  is  selected,  the  characteristic  polynomial  coeffi- 
cients are  given  in  the  usual  ascending  order  fashion,  with 
the  highest  order  coefficient  always  set  equal  to  1.0.   For 

example,  if  the  characteristic  polynomial  of  a  third  order 

2    3 

observer  is  chosen  to  be  16  +  4s  +  5s  +  s   the  last  two  data 

deck  cards  would  then  be: 

P 

16.0    4.0     5.0     1.0 
On  the  other  hand,  if  the  roots  are  to  be  entered  as  such, 
the  letter  F  is  written  on  the  option  card  followed  by  the 
observer  eigenvalues  presented  in  the  usual  manner.   For 
example,  if  the  observer  poles  are  -2,  -2,  -1+j ,  -1-j  the 
cards  would  then  be 

F 

2.0 

2.0 

1.0     1.0 
Note  the  sign  inversion  and  the  fact  that  only  the  complex 
root  with  the  positive  imaginary  part  is  entered. 

The  following  input  format  table  summarizes 
the  above. 
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Entry    Input  Description  Format 

1  Problem  identification,  5A4 , 
order  of  the  plant  N  <_  10,       312 
dimension  of  the  output 

vector  M,  order  of  the 
observer  L    (r-1) 

2  Plant  matrix  A  (N x n)  (one       8F10.3 
row  per  card  for  N  _<  8; 

one  row  per  two  cards  for 
N  >  8) 

3  Distribution  matrix  bT  (1 x N)     8F10.3 
(one  card  if  N  <  8;  two 

cards  if  N  >  8) 

4  Measurement  matrix  C  (M  x  n)       8F10.3 

(one  row  per  card  for 

N  _<  8 ;  one  row  per  two  cards 

for  N  >  8) 

5  Feedback  coefficient  matrix      8F10.3 
k   (1  x  n)  (on  one  card  if 

N  <_  8;  two  cards  if  N  >  8) 

6  Letter  F  (if  observer  eigen-     Al 
values  are  to  be  entered  as 
roots)  or  letter  P  (if 

observer  eigenvalues  are  to 
be  supplied  by  giving  a 
characteristic  polynomial) 

7  Entered  the  observer  eigen-      8F10.3 
values  as  specified  on  the 

previous  card.   (If  option  F, 
enter  the  roots'  real  and 
imaginary  parts;  if  option  P, 
give  the  characteristic 
polynomial  coefficients 
in  ascending  order) . 


Columns  Used 

1-20,  21-22, 
23-24,  25-26 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


Table  XIV  -  Input  Format  Table  for  LUEN 
c.   Output 

r 

The  problem  identification  followed  by  the  A,  b' 
and  C  matrices,  the  desired  feedback  coefficients  and  the 
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observer  eigenvalues,  both  in  factored  and  unfactored  form, 
are  presented  for  reference.   The  observer  and  controller 

elements  are  printed  next  as  the  F  matrix,  the  G,  matrix, 

T 

the  G  matrix,  the  output  feedback  coefficients  g   and  the 

T 
compensator  feedback  coefficients  h  . 

The  complete  solution  of  a  problem  should  also 
include  the  results  from  the  subprograms  STVAR,  OBSERV  and, 
if  a  simulation  is  performed,  GTRESP . 
d.   Example 

The  example  presented  by  Eveleigh  [6]  pp.  357-360 
was  slightly  rearranged  and  the  state  variables  x3  and  x^ 
were  assumed  to  be  inaccessible.   The  signal  flow  graph  for 
the  uncompensated  system  is  then: 


Fig  3-27   Uncompensated  System  for  LUEN  Test 


where  y   is  the  controlled  output  and  x^t)  and  x2  (t) 
are  the  measured  states. 
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From  the  diagram,  the  system  matrices  are 


A  = 


1 

0 

0 

•15 


0 

1 

0 

■23 


0 

0 

1 

-9 


b   =     [0     0 


1] 


c   =     [20    10     0     0] 


The  solution  presented  next  utilizes  the  design  procedure  of 
part  a. 

Step  1 
The  closed-loop  transfer  function  to  be  achieved  is  chosen 
to  be: 


Yc(s) 


R(s) 


s4  +  6s3  +  17s2  +  28s  +  20 


(s  +  2)  (s  +  2)  (s  +  l  +  j2)  (S  +  1-J2) 


The  controller  gain  K  and  the  feedback  coefficients  required 
are  found  by  the  use  of  the  subprogram  STVAR  for  which  the 
control  cards  and  data  deck  are: 
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STATE  VARIABLE  FEFCBACK 

PROBLEM  IDENTIFICATION  -       STVAR  FOR  LUEN  TEST 

The  A  MATRIX 

0.0  l.OOOOOOOE  00       0.0                 0.0 

0.0  O.G                 l.OOOOOOOE  00       0.0 

0.0  0.0                                              0.0                                              l.OOOOOOOE    00 

0.0  -l.OOOOOOOE  01                 -2.3000000E  01                 -9.0000000*    00 

THE   S   MATRIX 

0.0  0.0  0.0  l.OOOOOOOE    00 

•••••••••••ft********************************* 

OPEN-LOOP    CALCULATIONS 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENOING    POWERS   OF    S 

0.0  l.SCOCOCOE    01  2.3C00000E    01  9.0000000E    00  l.OOOOOOOE   00 

THE    ROOTS    ARE  R5AL    PART  IMAGINARY    PART 

-3.0CC00OO=    00  0.0 

-*. 9999990ft    00  0.0 

-9.9999994E-01  0.0 

0.0  0.0 

THE    C    MATRIX  •*••# 

2.0000000E   01  l.OOOOOOOE    01  0.0  0.0 

NUMERATOR   COEFFICIENTS   -    IN    ASCENOING    POWERS   OF    S 

2.0000O00E    01  l.OOOOOOOE    01 

THE    ROOTS    4RE  REAL    P4PT  IMAGINARY    PART 

-2.0COOOOO=    00  0.0 


CLOSED-LOOP   CALCULATIONS 
KEY    •    F         ••••« 

THE    NUMERATOR   OF    H-EQUIVALENT   -    IN   ASCENOING    POWERS    OF   S 

2.0000000E   01  1.3C0CCC0E    01  -6.0000000E    00  -3.0000000E   00 

THE    ROOTS   ARE  REAL    PART  IMAGINARY    PART 

-1.03*6233?  00  0.0 

3.2062893E  00  0.0  .    . 

THE    FEEDBACK   COEFFICIENTS 

2.0000000 E    01  1.3000000E    01  -6.0000000E    00  -3.0000000E    00 

THE   GAIN   ■         l.OOOOOOOE    00 
THE    CL0SE3-L00P    CHARACTERISTIC    POLYNOMIAL  -    IN   ASCFNOING    POWERS    OF   S 

2.00C00O0E    01  2.600GC00E   01  1.7000000E   01  6.0000000E   00  l.OOOOOOOE    00 

THE    ROOTS    ARE  REAL    PART  IMAGINARY    PART 

-l.OOOOOOOE  00  -2.0000000E    00 

-I. 00000005  00  2.0000000E    00 

-2.0Q0<.845<=  00  0.0  .  . 

-1.99S5155E  00  0.0 

MAXIMUM   NJRMALIZED   ERROR    -      0.0 


Figure   3-28      STVAR  Results    for  LUEN  Test 
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//  (standard  OS  JOB  card) 
//.EXE C.LIN CON 
//LINK.SYSIN.DD^* 
.. INCLUDE. SYSLIB (STVAR) 
/* 

//GO.SYSIN.DD.* 
STVAR  FOR  LUEN  TEST  04 
0.0       1.0       0.0       0.0 
0.0       0.0       1.0       0.0 
0.0       0.0       0.0       1.0 
0.0      -15.0     -23.0     -9.0 
0.0       0.0       0.0       1.0 
20.0      10.0      0.0       0.0 
(blank  card) 
F 

2.0 
2.0 

1.0       2.0 
(blank  card) 
/* 

Results  shown  in  Fig.  3-28  indicate  that  the  system  is  com- 
pletely controllable,  the  plant  eigenvalues  are  -3,  -5,  -1, 
and  0,  the  feedback  coefficients  are  20,  13,  -6  and  -3  and 
the  controller  gain  K  equals  unity. 

Step  2 
The  observability  index  is  determined  using  the  subprogram 
OBSERV.   The  computer  cards  are  as  follows: 
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//  (standard  OS 

JOB  card) 

//^EXEC^LINCON 

//LINK.SYSIN~DD. 

.* 

^INCLUDE  .SYSLIB  (OBSERV] 

1 

/* 

//GO.SYSIN^DD^* 

LUEN  TEST 

0402 

0.0      1.0 

0.0 

0.0 

0.0      0.0 

1.0 

0.0 

0.0      0.0 

0.0 

1.0 

0.0      -15.0 

-23.0 

-9.0 

1.0      0.0 

0.0 

0.0 

0.0      1.0 

0.0 

0.0 

/* 

Step  3 
An  observability  index  r  =  3  (results  taken  from  OBSERV 
output.  Fig  3-29)  permits  us  to  design  an  observer  of  order 
equal  to  or  greater  than  (r-1)  =  2.   Here  a  reduced-order 
observer  is  being  designed  and  eigenvalues  of  -3.5  and  -4.0 
were  selected  for  the  observer.   Note  that,  as  required, 
there  are  no  common  eigenvalues  for  the  plant  and  the 
observer. 

Step  4 
The  data  for  the  subprogram  LUEN  are: 

system  order:   04 

number  of  measurements:   02 

order  of  the  observer:   02 
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A      = 


T> 

1 

0 

0" 

0 

0 

1 

0 

0 

0 

0 

1 

o 

-15 

-23 

-9. 

plant  matrix 


=       [0 


1]     /        distribution  matrix 


C   = 


c  : 


0 

6 

,   state  measurement 

0 

0 

matrix 

=   [20     13     -6     -3]  ,   desired  feedback 

coefficients 
(from  STVAR) 


observer  eigenvalues:   -3.5,  -4.0 

The  following  set  of  cards  is  then: 
//  (standard  OS  JOB  card) 
//^EXEC^LINCON 
//LINK. SYS IN  J3D^* 
^INCLUDE  ^SYSLIB  (LUEN) 

/* 

//GO.SYSIN^DD^* 

LUEN  TEST  040202 

0.0     1.0  0.0     0.0 

0.0     0.0  1.0     0.0 

0.0     0.0  0.0     1.0 

0.0     -15.0  -23.0   -9.0 
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0.0     0.0     0.0     1.0 

1.0     0.0     0.0     0.0 

0.0     1.0     0.0     0.0 

20.0    13.0    -6.0    -3.0 

F 

3.5 

4.0 

/* 

From  the  results  shown  in  Fig  3-30,  the  complete  system  can 

be  described  as: 


x(t)      = 


U° 


1 
0 
0 
■15 


0 
1 
0 
•23 


0 

0 

1 

-9 


xx(t) 
x2(t) 
x3(t) 
x4(t) 


u(t) 


x(t)       = 


^14  Oj 


x3(t) 


x4(t) 


p35.5 
0 


29.251      [xl(tT|  +  T-3     1         u 

o     J  [x2(t)j  L-1-5] 


(t) 


u(t)      =         [1.0]r(t)    -    [20        8.5] 


E:x(t) 
:2(t) 


-    [1.0  0.0] 


x3(t) 
x4(t) 
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ORSERVABJl ITY    tNOEX    CALCULATION 

PROBLEM    IDENTIFICATION-  CeSSPV   FOR    LUEN    TEST 

ft******************************************** 
THE    A    MATRIX 


0.0 
0.0 
0.0 
0.0 

THE    C    MATRIX 

l.OOOOOOOE    00 
0.0 


l.OCOCOOOE  00 

0.0 

0.0 

-1.5C0CC00E  01 


0.0 
l.COOOOOGE  00 


0.0 

l.OOOOOOOE  00 
0.0 
-2.30O0OOOE  01 


0.0 
0.0 


OBSERVABILITY  INOEX     3 


Figure  3-29   OBSERV  for  LUEN  Test 


o.o 

0.0 

l.OOOOOOOE    00 
-9.0000000E    00 


0.0 
0.0 


LUENBERGER  OBSERVER  OESIGN  PROGRAM 
PROBLEM  IDENTIFICATION-     LUEN  TEST 

«••«••«•»«•»««•••■•»•»»»»••««»»«*«•**«»««**« 

THE  A  MATRIX 


0.0 
0.0 
0.0 
0.0 

l.OOOOOOOE 
0.0 
0.0 
-1.50O0C0OE 

00 
01 

0.0 

l.OOOOOOOE    00 
0.0 
-2.3  0OOOOOE   01 

0.0 
0.0 

l.OOOOOOOF. 
-9.0000000E 

00 
00 

THE    B    MATRIX 

0.0 

0.0 

0.0 

l.OOOOOOOE 

00 

THE    C    MATRIX 

l.OOOOOOOE    00 
0.0 

0.0 

l.OOCCCCCE 

00 

0.0 
0.0 

0.0 
0.0 

DEStRED    FEEDBACK    CCEFFICIENTS 
2.0000000E   01  1.3C000OOE    01 


-6.0000000E    00 


OBSERVER    EIGENVALUES 
REAL    PART 


IHAG    PART 


-3.5000000E    00  0.0 

-4.00QJ000E    00  0.0 

COEFFICIENTS    OF    OBSERVER    CHARACTERISTIC    POLYNOMIAL 
-IN   ASCENOING   POWERS   OF    S 

l.OOOOOOOE    01  7.5000000E   00  l.OOOOOOOE    00 

*#»«•*•••**•*»•♦•»•*»*•»*•***•*»***•*••*•***# 

THE    F    MATRIX 


l.OCOOOOOE   00 
0.0 


2.9249939E    01 
0.0 


-7.5000000E    00 
-l.OOOOOOOE    01 

THE   Gl    MATRIX 

B.5099969E    01 
0.0 

THE   G2    MATRIX 

-2.9999971E    00 
-1.5000010E    00 

OUTPUT    FEEDBACK    COEFFICIENTS 
2.00000006   01  8.5000038E   00 

COMPENSATOR    FEEDBACK   CCEFFICIENTS 
l.OOOOOOOE    OO  0.0 


-3.00000006    00 


Figure  3-30   Luenberger  Observer  Design  -  Computer  Results 
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From  these  equations  a  block  diagram  or  a  signal  flow  graph 
could  be  drawn  showing  the  compensated  system. 

Step  5 
The  system  is  simulated  by  the  use  of  the  graphical  time 
response  subprogram  (GTRESP)  for  a  unit  step  input.   After 
some  matrix  manipulation,  the  following  augmented  system  is 
obtained: 


*(t) 

x(t) 


0  10  0 

0  0  10 

0  0  0  1 

-20         -23.5    -23  -9 

145.5     54.75     0  0 

30  12.75     0  0 


0 

<f 

Xj^tt) 

0 

0 

x2(t) 

0 

0 

x3(t) 

-1 

0 

x4(t) 

-4.5 

1 

x3(t) 

12.5 

0_ 

*4<« 

0 
0 
0 

1 

-3 

-1.5 


r(t) 


yc(t) 


=       [20 


10 


0] 


x(t) 
x(t) 


=      0 


155 


K  =  1.0 

For  a  step  input,  r(t)  =  1.0  and  initial  condition     x(0] 
the  initial  and  final  times  are  0  and  10,  x(0) 

respectively,  the  integration  time  step  is  0.0025,  and  the 
plotting  parameter  FREQ  is  100. 

The  computer  deck  for  GTRESP  is  then: 
//  (standard  OS  JOB  card) ,TIME=2 
//  EXEC  LINCONF 
//FORT  .  SYS  IN  -DD  -  * 

SUBROUTINE  RFIND(T,R) 

R=1.0 

RETURN 

END 

/* 

//LINK.SYSIN~DD~* 
^INCLUDE^SYSLIB  (GTRESP) 

/* 

//GO.SYSIN~DD~* 

GTRESP  FOR  LUEN  TEST   06 


=  0 


0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

-20.0 

-23.5 

-23.0 

-9.0 

-1.0 

0.0 

145.5 

54.75 

0.0 

0.0 

-4.5 

1.0 

30.0 

12.75 

0.0 

0.0 

-12.5 

0.0 

0.0 

0.0 

0.0 

1.0 

-3. 

-1.5 

20. 

10. 

0.0 

0.0 

0.0 

0.0 
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0.0 

1.0 

o.o 

0.0        10.0       0.002        100. 
Y 

/* 

The  results  are  shown  in  Fig  3-31.   The  user  is  reminded 
that  the  observer  does  supply  estimates  of  the  missing 
components  of  the  state  vector  but  at  the  expense  of  adding 
its  own  poles  to  the  over-all  system. 

For  comparison,  a  run  is  also  made  simulating 
the  system  that  would  have  been  obtained  if  all  states  were 
measured,  using  the  feedback  coefficients  and  controller 
gain  from  STVAR  subprogram  results.   Since  the  same  forcing 
input  is  used,  the  control  cards  remain  the  same  and  the  data 
cards  are  changed  to  read: 
ALL  STATES  MEASURED  04 
0.0 
0.0 
0.0 
0.0 
0.0 
20.0 
20.0 
1.0 

(blank  card) 

0.0       10.0      0.002     100. 
Y 

/* 

157 


1.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 
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-15.0 

-23.0 
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1.0 

20.0 
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-3.0 
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The  time  response  obtained  in  Fig  3-32  is  almost 
identical  to  the  one  of  Fig  3-31,  showing  that  the  observer 
designed  does  a  very  good  job. 

6 .   Series  Compensator  (SERCOM) 

This  subprogram  is  used  to  design  optimal  linear, 
time-invariant  control  systems  with  incomplete  state  measure- 
ments.  The  optimality  criterion  here  is  in  terms  of  a 
specified  closed-loop  transfer  function  to  be  achieved.   The 
main  idea  behind  the  subprogram  is  to  construct  a  series 
compensator  such  that  the  need  for  feedback  from  the  unmeasured 
state  variables  is  eliminated.   The  way  to  accomplish  this 
is  presented  in  [8]  and  [1]  and  the  theory  is  not  repeated 
here.   The  user  should,  however,  familiarize  himself  with  the 
subject  before  attempting  to  solve  problems  by  the  use  of 
the  subprogram  SERCOM. 

The  following  paragraphs  outline  the  computer-aided 
design  procedure,  the  inputs  required  and  the  expected  output. 
To  illustrate  the  technique  an  example  problem  is  worked  out 
in  detail.   Notice  that  the  overall  procedure  differs  from 
the  one  presented  in  [1] . 

a.   Design  Procedure 

Before  the  step-by-step  design  procedure  is  out- 
lined, it  is  necessary  to  recall  the  main  equations  from  [8] 
and  [1] .  First  the  uncompensated  system  state  equations  are 
(as  for  LUEN)  of  the  form 
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x(t)   =   A  x(t)  +  B  u(t) 


Yn(t)   =   c  x(t) 


y(t)   =  C  x(t) 


where 


y  (t)   =   output  variable  to  be  controlled  (could 
be  one  of  the  measured  states  or  a 
linear  combination  of  them) 

c      =   output  variable  vector 

v/t\    _   vector  of  measured  components  of 
~         state  vector 

C      =   state  measurement  matrix 


An  arbitrary  dynamic  controller 


z(t)   =   D  z(t)  +  e  w(t) 


u(t)   =   fTz(t) 


is  added  to  the  above  system.   It  is  to  be  noted  that  z(t) 
are  defined  as 


zT(t)   =   [u(t)   u(t)   u(t)   ...   u(k_1)(t)] 


w(t)   =   u(k)(t) 
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f    =   [1    0    0 


0] 


e  = 


"01 

0 


and 


1 


0 

1 

0 

0" 

0 

0 

1 

0 

0 

0 

•               ■ 

0 

1 

0 

0 

0 

0 

'J 


The  complete  system  then  takes  the  form 


x(t)   =  A  x(t)  +  b  u(t) 


z(t)   =   D  z(t)  +  e  w(t) 


w(t)   =   f  z(t) 


w(t)   =  K[r(t)  -  k^xtt)  -  k2Tz(t)] 


The  block  diagram  representation  is  shown  in  Figure  3-33A. 
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Fig  3-33A  Serially  Compensated  System 

with  Complete  State  Measurements 
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It  is  clear  that  this  closed-loop  system  does  not  solve  the 
problem  since  it  uses  all  the  state  variables.   It  is  possible, 
however,  starting  from  this  system,  to  eliminate  the  feedback 
from  the  unmeasured  state  variables  and  this  is  the  purpose 
of  the  subprogram  SERCOM.   Thus,  given  the  above  control 
system,  the  computer  program  accomplishes  the  necessary 
transformations  and  outputs  the  new  closed- loop  system 

x(t)   =  A  x(t)  +  b  u(t) 
y(t)   =   C  x(t) 

v(t)   =   D  v(t)  +  G  y(t)  +  Ker(t) 

u(t)  =  fTv(t)  +  gTy(t) 

(or  in  block  diagram  form,  as  in  Figure  3-33B) , 
with 

A  =  plant  matrix 

b  =  distribution  vector 

D  =  compensator  matrix 

G  =  major  loop  feedback  coefficient  matrix 

e  =  input  vector 

K  =  input  gain  (a  scalar) 

fT  =  compensator  output  matrix 

gT  =  minor  loop  feedback  coefficient  matrix 
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Fig  3-33B  Serially  Compensated  System  with 
Incomplete  State  Measurements 
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From  theory,  such  a  linear  compensator  can  be  designed  pro- 
vided the  order  of  the  controller  is  at  least  (r-1) ,  where 
r  is  the  observability  index  of  (A,C)  [8] . 

To  summarize  the  above  expose  and  give  a  practi- 
cal means  of  using  the  method,  a  step-by-step  design  proce- 
dure is  presented.   After  the  theory  of  the  series  compensa- 
tor method  has  been  assimilated,  it  should  be  sufficient  to 
just  follow  these  few  steps  and  look  at  the  input  format  table 
for  SERCOM  to  solve  any  given  problem. 

Step  1 
The  subprogram  OBSERV  is  used  to  find  the  observability  index 
r  of  (A,C) .   If  the  system  is  observable,  the  minimum  order 
for  the  compensator  is  then  established  as  (r-1) . 

Step  2 

T       T 
The  D,  f  and  e  matrices  are  selected  such  that  their 

dimensions  are 

D:   (r-1)  x  (r-1) 


eT:   1  x  (r-1) 


fT:   1  x  (r-1) 


It  is  to  be  remembered  that 


fT  =   [1     0     0     ...     0     0] 
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e   =   [0   0   0 


0    1] 


0    10 
0    0    1 


0    0    0 
0    0    0 


0    0 
0    0 


0    1 
0    0 


For  instance,  for  a  compensator  of  order  one, 


T 
f   =   1 


ex  =   1 


D   =   0 


while  for  a  compensator  order  equal  to  two, 


f1   =   [1    0] 


e1   =   [0   1] 


D  = 


C  3 


The  augmented  system  is  then  written  as 
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x(t) 
z(t) 


b  ! 


D' 


x(t) 
z(t) 


u(t) 


This  form  complies  with  the  format  necessary  to  use  the 
subprogram  STVAR  of  step  3. 
Step  3 


A  desired  closed-loop  transfer  function 


Yc(s) 
R(s) 


is  specified 


for  the  augmented  system.   The  order  of  the  combined  system 
is  (n  +  r  -  1)  .   For  example,  suppose  that  a  third  order  system 
is  to  be  serially  compensated.   Its  observability  index, 
found  using  OBSERV,  is  r  =  2.   Then  a  fourth  order  polynomial 
must  be  chosen  to  characterize  the  desired  closed-loop 
behavior. 

At  this  point,  all  states  are  assumed  to  be 
available  for  measurement  and  the  subprogram  STVAR  is  used  to 

obtain  the  controller  gain  K  and  the  feedback  coefficient 

T        T  T 

matrix  k,   and  k?  .   It  is  recalled  that  k,   contains  the 

T 
plant  feedback  coefficients  while  k~   contains  those  for  the 

compensator. 

Step  4 
The  compensating  elements  for  the  augmented  system  are  com- 
puted and  the  required  matrix  transformations  accomplished  by 
the  use  of  the  subprogram  SERCOM.   The  final  system  takes 
the  form 
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x(t)   =  A  x(t)  +  b  u(t) 


v(t)   =   D  v(t)  +  G  y(t)  +  Ker(t) 


u(t)   =   fTv(t)  +  gTy(t) 


y(t)   =  C  x(t) 

where  all  elements  are  given  in  the  output  of  SERCOM. 

Step  5 
If  desired,  the  compensated  system  is  simulated  using  GTRESP. 
As  for  Luenberger  Observers,  some  simple  matrix  manipulations 
are  required  to  put  the  equations  into  the  form 


x(t) 
v(t) 


h 


x(t) 
v(t) 


+   bx  u(t) 


yc(t)   =   c 


ri 


x(t) 
v(t) 


u(t)   =  r(t) 


kA   =   0 


gain  =   K 
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x(t  )   =   0 
o 


The  graphical  time  response  subprogram  with  appropriate 
time  specifications  is  then  run. 
b.   Input 

The  data  deck  includes  all  the  parameters  defined 
for  the  augmented  system.   To  avoid  any  mistake,  the  user 
should  refer  to  the  design  procedure  for  comparison.   The 
input  data  cards  start  as  usual  with  the  problem  identifica- 
tion, the  order  of  the  plant  N,  the  number  of  measurements 
M  and  the  compensator  order  (r-1)  or  greater.   The  complete 
system  matrices  are  then  presented,  one  row  at  a  time,  in 
the  following  order:   A  (N  x  N)  ,  bT  (lxN),  C  (M  x  N)  , 

D[(r-1)  x  (r-1)],  eT[lx  (r-1)]  and  fT[lx  (r-1)].   On  the  final 

T        T 
cards,  the  feedback  coefficient  matrices  k..   and  k   and  the 

controller  gain  K  are  presented.   For  a  zero  steady-state 

error  to  a  step  input,  these  would  be  entered  exactly  as 

they  appeared  on  the  subprogram  STVAR  output.   The  following 

input  format  table  summarizes  the  entries  required  for  SERCOM. 

Entry    Input  Description  Format     Columns  Used 

1  Problem  identification  5A4  1-20,  21-22, 
order  of  the  plant  (N  <  10),  312  23-24,  25-26 
number  of  measurements  =  M, 

compensator  dimension  =  (r-1) 
or  greater 

2  Plant  matrix  A  (N x n)  (one      8F10.3     1-10,  11-20, 
row  per  card  for  N  _<  8;  21-30,  etc. 
one  row  per  two  cards  for 

N  >  8) 
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Entry   Input  Description  Format     Columns  Used 

3  Distribution  vector  bT  a  * N)     8F10.3     1-10,  11-20, 
(one  card  if  N  <  8;  two  21-30,  etc. 
cards  if  N  >  8) 

4  State  measurement  matrix        8F10.3     1-10,  11-20, 
C  (M x N)  (one  row  per  card  21-30,  etc. 
for  N  <_  8;  one  row  per  two 

cards  for  N  >  8) 

5  Compensator  Matrix  8F10.3     1-10,  11-20, 
D[(r-1)  x  (r-1)]  (one  row  21-30,  etc. 
per  card  for  (r-1)  <_  8;  one 

row  cards  per  two  cards  for 
(r-1)  >  8) 

6  Input  matrix  eT  (1  x  (r-1))       8F10.3     1-10,  11-20, 
(one  card  for^"  (r-1)  <_  8;  21-30,  etc. 
two  cards  for  (r-1)  >  8) 

7  Compensator  output  matrix       8F10.3     1-10,  11-20, 
fT[l*  (r-1)]  (one  card  21-30,  etc. 
if  (r-1)    8;  two  cards 

if  (r-1)  >  8) 

8  Feedback  coefficients  matrix    8F10.3     1-10,  11-20, 
[k,T  k2T]  (lxN+r-1)  (one  21-30,  etc. 
card  if  (N+r-1)  <_  8;  two 

cards  if  8  <  (N+r-1)  <_  16; 
three  cards  if  (N+r-1)  >  16) 

9  Controller  gain  K  8F10.3     1-10 

Table  XV  -  Input  Format  Table  for  SERCOM 


c.   Output 

First  the  information  given  as  input  is  listed, 

T  T    T 

i.e.,  the  problem  identification,  the  A,  b  ,  C,  D,  e  ,  f 

T    T 
and  [k,    k2  ]  matrices  and  the  controller  gain  K.   Next  the 

final  compensator  system  matrix  D[(r-1)  x  (r-1)]  is  printed 

(the  user  must  be  careful  not  to  confuse  this  matrix  with  the 

original  augmented  system  matrix  D) ,  followed  by  the  minor 
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feedback  coefficient  matrix  g   (1 x M)  and  the  major  loop 
feedback  coefficient  matrix  G  [ (r-1)  x m) . 
d.   Examples 

Two  design  examples  are  worked  out.   The  first 
one  is  a  simple  second  order  system  with  only  one  measured 
state  variable.   The  other  is  the  fourth  order  system  that 
was  used  to  demonstrate  Luenberger  Observers  in  the  previous 
section. 

(1)   Example  One 

A  design  of  a  feedback  system  is  required 
such  that  the  following  controllable  dynamical  equation 


x]_(t) 


x2(t) 


l" 

\(t) 

+ 

"o" 

-1_ 

x2(t) 

_1_ 

u(t) 


y(t)   =   [1   0]  x(t) 

has  a  time  response  to  a  step  input  approximately  the  same 
as  for  a  second  order  system  with  poles  at  -1  ±  j . 

Step  1.1 
The  observability  index  for  the  system  can  easily  be  found, 
by  hand  or  by  the  use  of  the  subprogram  OBSERV,  to  be  r  =  2 
Thus  a  first  order  compensator  is  sufficient. 

Step  1.2 
The  D,  fT  and  eT  matrices  are  selected  such  that: 
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D    =   0 


eA  =  1 


f   =  1 


and  the  augmented  system  takes  the  form 


x(t) 

0 

1 

0 

x(t) 

0 

z(t) 

= 

0 

-1 

1 

z(t) 

+ 

0 

0 

0 

0 

,1. 

u(t) 


Step  1.3 
The  degree  of  the  characteristic  polynomial  is  then  three. 
Since  the  desired  response  was  specified  to  be  similar  to  a 
second  order  system  with  closed-loop  poles  at  -1 +  j  and  -1  -  j , 
it  seems  appropriate  to  select  these  roots  plus  a  third  real 
root  with  a  large  negative  value .   The  subprogram  STVAR  is 
then  used  to  calculate  the  required  feedback  coefficients  and 
the  gain  for  roots  at  -10,  -1  +  j ,  -1  -  j .   The  computer  deck 
for  STVAR  is 

//  (standard  OS  JOB  card) 
/AEXECvLINCON 
//LINK.SYSIN^DD,,* 
^INCLUDE^SYSLIB  (STVAR) 

/* 

//GO. SYS IN „DD~* 
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0.0 

1.0 

0.0 

-1.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

STVAR  FOR  SERCOM1  0  3 

0.0 

0.0 

0.0 

1.0 

0.0 

(blank  card) 
F 

10. 

1.        1. 
(blank  card) 

/* 

The  results  are  shown  in  Fig.  3-34. 

Step  1.4 
Sufficient  information  is  now  available  to  run  the  subprogram 
SERCOM.   We  put  together  the  data: 

order  of  the  plant  =   02 

number  of  measured  states   =   01 

compensator  order  =   01 


plant  matrix  A  = 


0 


0 


-] 


T 
distribution  vector  b   =   [0     1] 

state  measurement  matrix  C  =   [1    0] 

compensator  matrix  D  =   0 

T 
input  matrix  e   =   1 

T 
compensator  output  matrix  f   =   1 
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STATE    VARIABLF    FcfcCdAC* 

PROBLEM    IDENTIFICATION   -  STV&R    FOR    SERCON    I 

•*•«•»*•»*»»*•****»*»*♦*»»**» *«*•»**«******** 

THE    A    MATRIX 

0.0  l.OCOOOCCE    00  0.0 

0.0  -I .0000000?   00  1.0000000=    00 

CO  0.0  0.0 

the  e  matr  ix 

0.0  0.0  l.OOOOOOOE   00 

A******************************************** 

OPEN-LOOP    CALCULATES  \ 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 

CO  0.0  l.OOOOOOOE   00  l.OOOOOOOE    00 

THE    ROOTS    ARE 


PEAL    PART 

IMAGINARY    PART 

-l.CCOOOOOE    00 

CO 

0.0 

0.0 

CO 

0.0 

THE    C    "ATRIX  ***** 

l.OOOOOOOE    00  0.0  .     0.0 

NUMERATOR    Ct EFFICIENTS    -    IN    ASCENDING    PCWERS   OF    S 
l.OOOOOOOE    00 
*••**•»*•**••*•»••«*******«*****» ************ 

CLOSED-LOOP    CALCULATIONS 
KEY    »    F         •  «•*• 

The    NU-FRATOR    OF     H-=QUIVALeNT    -    IN    ASCENOIMG    POWERS    OF    S 

l.OOOOOOOE    00  1.099999<»E    00  5. 4999995E-01 

THE    ROOTS    AFE  PEAL    PAPf  !M«r,TNABY    PART 

-S.CS09135F-01  0.0 

THE    FEEDBACK    COEFFICIENTS 

l.OOOOOOOE    00  5.4S9^SS5E-01  5. «999995=-0l 

the  gain  -      2.0000000E  01 

'THE    CLOSED-LOOP    CHARACTfcR T STI C    POLYNOMIAL   -    IN    ASCfNDING    POWERS    OF    S 

2.C0U0COJ?    01  2.1C3C000F    01  1.20OOOOO1"    01  1. 0000000=    00 

THE    RJOTS    APE  REAL    PAPT  IMAGINARY    PART 

-1.000.1000=  01  0.0 

-l.OOOOOOOE  00  -l.OOOOOOOE    00 

-l.COCOOOOE  00  l.OOOOOOOE    00 

MAXIMUM    NORMALIZED    ERRCR    »      6.94E-07 


Figure  3-34   STVAR  Results  for  SERCOM  Test  One 
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[k-j7   k2T]   =   [1    0.55    0.55],   (from  STVAR 

output) 

K   =   20   (from  STVAR  output) 

So  the  control  deck  and  data  cards  for  SERCOM  are: 

//  (standard  OS  JOB  card) 

// * EXEC.LINCON 

//LINK.SYSIN^DD,,* 

^INCLUDE^SYSLIB  (SERCOM) 

/* 

//GO.SYSIN^DD,,* 

SERCOM  TEST  ONE   02  0101 

0.0     1.0 


0.0 

-1.0 

0.0 

1.0 

1.0 

0.0 

0.0 

1.0 

1.0 

1.0 

0.55 

20.0 

/* 

0.55 


From  the  results  reproduced  in  Fig.  3-35,  it  is  easy  to 
determine  the  final  system  as 


x(t)   = 


1 
-1 


x(t)   + 


u(t) 
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SERIES    COMPLNSargp    ni^\r,S    PpgGRA" 
PfcOJCcM    tUSrjTIFICATICN-  SERCT*   TEST    I 

•**•***••«**•  *««***»*»***«**»**********  **••**• 
ThS   *    MATRIX 


0.0 

0.0 

l.CCCCCCCE 

-l.CCOCCCCc 

00 
00 

Tmc  3  MATRIX 

0.0 

l.OCOOCOCE 

00 

THE  C  MATRIX 

1.0030300F    00  0.0 

THE    0    MATOIX 

0.0 
THE    E    MATRIX 

I  .0000000?    00 
THE    F    MATRIX 

l.OOOOOOOE    00 
OESIr?0   FEEDBACK    COEFFICIENTS 

l.OOOOOOOE    00  5.*S9SSS5E-0l  5. 4999995E-01 

THE    GAIN    *  2.0000000E    01 

•»»•»■•••••■»«« «»***»•*•»«***»***»*********** 

THE    COMPENSATOR    SYSTEM    MATRIX 
-1.0999993E    01 

MJNOR   COOP    FECOttACK    COEFFICIENTS 
-1.1000000E    CI 

MAJOR  LOOP  FEFOBACK  COEFFICIENTS 
1.0100003E  02 
a************************ ******♦»»»«**«****** 


Figure   3-35      Serial   Compensator   Design  -   Test  One 


177 


v(t)   =   -llv(t)  +  101y(t)  +  (20)(l)r(t) 


u(t)   =  v(t)  -  lly(t) 


y(t)   =  x1(t) 


or,  equivalently, 


xx(t)   =   x2(t) 


x2(t)   =   -llx1(t)  -  x2(t)  +  v(t) 


v(t)   =   101x1(t)  -  llv(t)  +  20r(t) 


Step  1.5 
This  last  set  of  equations  can  be  readily  used  in  the  subpro- 
gram GTRESP  to  simulate  the  system  forced  by  a  unit  step 
input.   From  the  above  equations  one  gets: 


*1 


0     1      0 
-11    -1       1 
101     0    -11 


[0     0     20] 


c   =     [1     0     0] 
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kT   =   0 


K   =   1.0 


x(tQ)   =   0 


tQ   =   0.0  tf   =   10.0 


dt   =   0.002  FREQ   =   100 

We  assemble  the  computer  card  deck  as  follows: 

//  (standard  OS  JOB  card) ,TIME=2 

//*  EXEC^LINCONF 

//FORT  .  SYS  IN  „DD  ^* 

SUBROUTINE  RFIND(T,R) 
R  =  1.0 
RETURN- 
END 

//LINK.  SYS  IN^DD,,* 

„  „  INCLUDE,,  SYSLIB  ( GTRESP ) 

A/v  ENTRY,,  GTRESP 

/* 

//GO.SYSIN^DD^* 

GTRESP  FOR  SFRCOMl    03 

0.0        1.0        o.O 

-11.       -1.0       1.0 
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101  0.0  -11. 

0.0  0.0  20.0 

1.0  0.0  0.0 

0.0  0.0  0.0 

1.0 

0.0  0.0  0.0 

0.0  10.0  0.002     100. 

Y 

/* 

The  time  response  shown  in  Fig.  3-36  can  be  easily  compared 
with  the  actual  feedback  system  where  both  state  variables 
are  available  (by  the  use  of  STVAR  and  GTRESP)  and  a  decision 
made  regarding  the  suitability  of  the  compensated  system. 

Here  it  is  important  to  note  that  the  method 
increases  the  order  of  the  system  and  adds  undesired 
poles.   For  this  reason  it  is  always  wise  to  simulate  (using 
GTRESP) .   Another  good  way  to  investigate  the  results  is  to 
run  the  subprogram  STVAR  in  open-loop  mode  for  the  same  set 
of  eauations  as  for  GTRESP.   This  gives  the  designer  a  double 
check  on  the  accuracy  of  the  solution  and  verifies  the  con- 
trollability.  These  ideas  are  demonstrated  in  the  second 
example. 

(2)   Example  Two 

The  same  problem  presented  for  the 
Luenberger  Observer  example  is  used  here,  this  time  with  a 
series  compensator.   The  fourth  order  uncompensated  system 
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x(t)   = 


0 

1 

0 

0 

0 

0 

1 

0 

0 

0 

0 

1 

0 

-15 

-23 

-9 

x(t)  + 


u(t) 


with  measurement  equation 


Y(t)   = 


9. 


x(t) 


and  controlled  output 


yc(t)   =   [20 


10 


0]   x(t) 


is  to  be  controlled  so  the  overall  time  response  approaches 
the  one  that  would  result  from  feeding  back  the  states,  if 
they  were  all  measured,  for  a  fourth  order  system  with 
closed- loop  poles  at  -2,  -2,    -1  +  J2. 

Step  2.1 
The  observability  index  is  found  by  the  use  of  the  subpro- 
gram OBSERV  to  be  r  =  3.   Thus  the  compensator  order  must  be 
at  least  (r-1)  =  2. 

Step  2.2 

T       T 
D,  f   and  e  matrices  are  selected  as  follow: 


D  = 


1 
0 


=   [0 


1], 


=    [1 


0] 
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and  the  augmented  system  becomes 


x(t) 
z(t) 


0 

1 

0 

0 

0 

0 

"x(t) 

0 

0 

1 

0 

0 

0 

z(t) 

0 

0 

0 

1 

0 

0 

0 

-15 

-23 

-9 

1 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

u(t) 


yc(t)   =   [20 


10 


0]   x(t) 
z(t) 


Step  2.3 
Pole  placement  is  usually  dictated  by  some  time  response 
specifications.   The  desired  response  given  here  suggests 
that  four  of  the  closed-loop  poles  be  located  at  -2,  -2  and 
-1 ±  j2.   The  two  other  roots  are  undesired  and  a  rule  of 
thumb  is  to  place  them  to  the  left  of  the  desired  ones. 
Here   -3.5   and  -4.0  were  selected  and  the  subprograms 
STVAR  run  with  the  following  control  and  data  cards: 

//  (standard  OS  JOB  card) 

//  .EXECsLINCON 

//LINK.SYSIN^DD^* 

M INCLUDE^ SYSLIB (STVAR) 

/* 
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//GO.SYSIN-DD-* 

STVAR  FOR  SERCOM  2   06 


0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

-15. 

-23.0 

-9.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

20. 

10. 

0.0 

0.0 

0.0 

0.0 

(blank 

card) 

F 

1.         2. 

2. 

2. 

3.5 

4.0 

(blank  card) 

/* 

The  output  shown  in  Fig.  3-37  gives  the  gain  and 
feedback  coefficients  that  would  be  required  if  all  states 
were  measured. 

Step  2.4 
Since  some  of  the  states  are  not  measurable,  the  subprogram 
SERCOM  is  used  to  transform  the  original  system  into  the  appro- 
priate series  compensated  system.   The  information  necessary 
to  run  the  subprogram  is : 
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order  of  the  plant  =   04 
number  of  measured  states  =   02 
compensator  order  =   02 

"0     1 


plant  matrix  A  = 


-15    -23 


distribution  vector  bx   =   [0 
state  measurement  matrix  C  = 

compensator  matrix  D  =    0 

0 
T 


1 
0 


input  matrix  e 

compensator  output  matrix  f 


[0     1] 
T 


=   [1 


[~1T    ~2T]   =   [2°' 


25.3    8.07 
(from  STVAR  output) 


K   =   14.  ,   from  STVAR  output. 
The  computer  card  deck  is  then 
//  (standard  OS  JOB  card) 
//  * EXEC-LINCON 
//LINK. SYS IflUDD** 
~~INCLUDE~SYSLIB (SERCOM) 

/* 

//GO.SYSIN~DD~* 

SERCOM  TEST  ONE   040202 


0 

0 

1 

-9 


0] 


607 


1] 

0 
0 


.893    .321], 
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0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

-15. 

-23. 

-9. 

0.0 

0.0 

0.0 

1.0 

1.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

1.0 

1.0 

0.0 

20. 

25.321 

8.071 

.60 

14. 

/* 

The 

computer 

ou 

tput    (Fie 

J.    3 

.8983       .3214 


x(t)       = 


v(t)       = 


0 

1 

0 

0  ' 

x(t)    + 

o" 

0 

0           1 

0 

0 

0 

0           0 

1 

0 

0 

-15      -23 

-9_ 

1 

»       « 

"0 

f 

v(t) 

+       T88.75 

20 

p 

0, 

Lo 

0 

+       14 

r(t 

) 

u(t) 


y(t) 
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u(t)   =     [1     0]  V(t)   +   [-54     -8.5]  y(t) 

y(t)   =10     0     0    x(t) 
0     10     0 

Step  2.5 
Again  it  is  relatively  straightforward  to  rearrange  the 
equations  in  an  augmented  system  form  suitable  for  simulation 
using  the  subprogram  GTRESP.   For  completeness  the  result  is 
given  here. 


0 

1 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

n 

0 

0 

0 

1 

0 

0 

Al     " 

-54. 

-23.5 

-23 

-9 

1 

0 

88.75 

-20.74 

0 

0 

0 

1 

[' 

0 

0 

0 

-12.58 

-4.5 

k  T 

[0 

0 

0 

0 

0 

14] 

gain   =   1 


c  =   [20     10     0 


0] 


=   0 


x(tQ)   =   0 
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The  time  specifications  are  chosen  to  be 

tQ   =   0  tf   =   10 

dt   =   0.002        FREQ     =   100 

and  the  control  and  data  cards  for  the  graphical  time  response 
subprogram  with  a  unit  step  input  are 
//  (standard  OS  JOB  card) ,  TIME=2 
//_EXECJLINCONF 


//FORT . SYS IN  ^DD^  * 

SUBROUTINE  RFIND(T/ 

-R) 

R  =  1.0 

RETURN 

END 

/* 

//LINK.SYSINJDD,,* 

.„  INCLUDE  ^SYSLIB (GTRESP) 

/* 

//GO.SYSIN  J5D„* 

SERCOM  TEST  TWO    06 

0.0       1.0       0.0 

0.0 

0.0 

0.0 

0.0       0.0       1.0 

0.0 

0.0 

0.0 

0.0       0.0       0.0 

1.0 

0.0 

0.0 

-54.      -23.5     -23. 

-9. 

1.0 

0.0 

88.75     -20.74    0.0 

0.0 

0.0 

1.0 
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0.0 

0.0 

0.0 

0.0 

-12.58 

-4.5 

0.0 

0.0 

0.0 

0.0 

0.0 

14.0 

20.0 

10. 

0.0 

1.0 

0.0 

0.0 
v 

10. 

0.002 

100. 

X 

/* 

Results  in  Fig.  3-39  are  very  similar  to  those 
obtained  for  the  Luenberger  Observer  system.   The  response 
can  be  compared  against  the  original  specifications.   If  unsat- 
isfactory, the  designer  can  redo  the  problem  using  different 
pole  locations.   As  mentioned  at  the  end  of  the  previous 
example,  it  might  be  good  to  find  out  if  any  mistake  was 
made  by  verifying  the  location  of  the  closed- loop  poles.   This 
is  easily  accomplished  by  running  the  subprogram  STVAR  for 
open-loop  calculations  for  the  above  augmented  system.   The 
data  deck  consists  of  the  problem  identification,  the  system 
order,  A,  b  and  C  matrices  and  two  blank  cards.   The  complete 
computer  deck  is 
//  (standard  OS  JOB  card) 
//   EXEC  LINCON 
//LINK.SYSIN^DD,,* 
^ INCLUDE ^SYSLIB (STVAR) 

/• 

//GO.  SYS  IN  ^DD^* 
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SERCOM 

TEST 

2 

06 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

-54. 

-23. 

5 

-23. 

-9.0 

1.0 

88.75 

-20. 

74 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

-12 

0.0 

0.0 

0.0 

0.0 

0.0 

20. 

10. 

(blank 

card) 

(blank 

card) 

/* 

0.0 
0.0 
0.0 
0.0 
1.0 
58  -4.5 
14.0 


T 
Note  that  the  gain  K  is  carried  inside  the  b 

matrix  as  required  by  the  equations  representing  the  final 

compensated  system.   Results  presented  in  Fig.  3-40  show  that 

the  roots  are  very  close  to  their  originally  specified 

locations. 

7.   Optimal  Control/Kalman  Filters  (RICATI) 

RICATI  is  a  double-precision  subprogram  used  to  solve 

the  Riccati  differential  equations 


P(t)   =   -P(t)A  -  ATP(t)  +  P(t)  BP."1BTP(t)  -  Q     (1) 


and/or 


~,T    =>,,_,  „T=-1  -,^    „^r„T 


Pit)    =   AP(t)  +  PA   -  P(t)C  R   CP(t)  +  BQB       (2) 
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to  obtain  the  gain  matrix 


Gc(t)   =   R-1BTP(t)  (3) 


or/and 


Gf(t)   =   R  1CP(t)  (4) 


Equations  (1)  and  (3)  pertain  to  the  solution  of  the 
state-regulator  problejri  while  (2)  and  (4)  occur  in  the  con- 
tinuous Kalman  filter  algorithm.   For  convenience  a  brief 
discussion  of  each  subject  is  included.   First  the  state- 
regulator  problem:   given  a  linear,  time-invariant  system 
[9] 

x(t)   =   A  x(t)  +-B  u(t) 


y(t)   =   C  x(t) 

where  u(t)  is  not  constrained,  a  control  law  is  to  be  found 
such  that  the  quadratic  cost  function 

J   =   £[xT(t-)P-x(t-)]  +  \        J   [xT(t)Qx(t)  +uT(t)Ru(t)]dt 
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is  minimized.   Such  an  optimal  control  exists,  provided 
that  P-  and  Q  are  positive  semidefinite  and  R  is  positive 
definite,  and  is  given  by 


u(t)   =   -fVpit)  x(t)   =  -G  (t)  x(t) 


where  P(t)  is  the  uniaue  solution  of  the  differential  Riccati 
equation 


P(t)   =   -P(t)A  -  ATP(t)  +  P(t)BR~1BTP(t)  -  Q 


with  the  boundary  condition  P(tf)  =  P-;  t-  is  a  specified 
value.   The  RICATI  subprogram  is  used  to  determine  the  control 
crain  matrix 


Gc(t)   =   R'Vp(t) 


such  that  the  closed- loop  system 


x(t)   =   A  x(t)  +  B  u(t) 


u(t)   =   -G  (t)  x(t) 


y(t)   =   C  x(t) 

is  optimal  with  respect  to  the  specified  performance  measure. 
The  computer  can  solve  for  either  or  both  the  transient  and 
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t 


2 

the  steady-state  control  gains."   Notice  that  the  gain  matrix 

Gc(t)  output  by  the  computer  does  not  include  the  negative 
sign  of  the  feedback  loop. 

For  the  second  type  of  problem,  a  continuous  Kalman 
filter  is  to  be  obtained  and  the  subprogram  RICATI  is  used 
to  find  the  optimal  filter  gain  matrix  for  the  design.   Here 
again  the  user  has  a  choice  of  getting  either  or  both  the 
transient  and  the  steady-state  gains.    The  problem  to  be 
solved  is  to  find  an  optimal  filter  for  a  linear,  time- 
invariant  system  [10] 

x(t)   =   A  x(t)  +  B  w(t) 

z(t)   =   C  x(t)  +  v(t) 

where  v(t) ,  the  measurement  noise,  is  uncorrelated  and  has 
covariance  matrix  Q.   The  random  process  forcing  input  w(t) 


2 
The  conditions  sufficient  for  steady-state  control 

to  exist  are  that  the  system  be  completely  controllable,  i.e., 

the  matrix  [B  AB   ...   An~lB]  be  of  rank  n  where  n  is  the 

order  of  the~plant,  that  "no  terminal  cost  be  considered  in  the 

cost  function  and  that  A  and  B  be  time-invariant.  [9] 

Sufficient  conditions  for  steady-state  filter  gains  to 
exist  are  [10] : 

(a)  the  plant  must  be  completely  observable 

(b)  the  plant  must  be  time-invariant,  i.e.,  A,  F 
and  C  are  independent  of  time 

(c)  the  random  processes  y(t)  and  w(t)  are  stationary, 
i.e.,  R  and  Q  are  constant. 
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is  also  uncorrelated  and  has  covariance  matrix  R.   The 
expected  values  of  the  initial  states  are 


*o   "   E[?(to)] 


The  solution  is  obtained  by  choosing  the  filter  gain  matrix 


Gf(t)   =   R"1CP(t) 


such  that  the  plant,  measurement  and  Kalman  filter  are 


x(t)   =   A  x(t)  +  B  w(t) 


z(t)   =   C  x(t)  +  v(t) 


x(t)   =   A  x(t)  +  Gf(t) [z(t)  -  C  x(t)] 


These  equations  are  also  presented  in  block  diagram  form  in 
Figure  3-41. 

The  purpose  of  the  subprogram  RICATI  is  to  solve  the 
differential  Riccati  equation 


P(t)   =   A  P(t)  +  P(t)AT  +  BQBT  -  P(t)CTR~1CP(t) 


with  initial  condition 
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P(tQ)   =  PQ  =  E[(x(t0)  -xo)  •  (x(to)  -  xo)T] 


to  calculate  the  filter  gain  matrix  Gf(t). 
a.   Input 

A  common  input  format  applies  to  both  state- 
regulator  and  Kalman  filter  problems.   However  the  matrix 
definitions  differ. 


A 


s  < 


&  [=O^C> 


x(t) 


Fig  3-41   Continuous  Kalman  Filter  Block  Diagram 

(1)   Basic  Input 

The  input  data  deck  first  card  contains  the 
problem  identification/  the  order  of  the  plant  (N  <_  10)  ,  the 
number  of  control  inputs  (M  <_  10)  and  the  number  of  measured 
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outputs  (L  <_  10) .   Since  these  numbers  define  the  dimensions 
of  each  subsequent  matrix ,  extra  care  is  suggested.   Next 
the  plant  matrix  A  (N x n)  is  entered  one  row  at  a  time.   Simi- 
larly  the  control  matrix  B   (M  x  n)  and  the  observable  output 
matrix  C  (L x n)  are  given.   The  above  forms  the  basic  input 
and  needs  only  be  included  once. 

(2)  Control  Option  Input 

This  portion  of  the  data  is  used  when  solving 
state-regulator  problems.   The  letter  C  is  printed  in  the 
first  column  of  the  first  card  to  indicate  that  option  con- 
trol is  selected.   On  this  same  card,  if  and  only  if  transient 
gains  are  desired,  the  user  gives  the  initial  time  tn , 
the  final  time  tf  and  the  number  of  time  points  of  the  control 
gain  matrix  (  NPOINT  )  to  be  printed.   If  the  steady-state 
solution  only  is  desired,  the  letter  C  still  appears  in 
column  one  but  the  rest  of  the  card  is  left  blank. 

Next  the  control  weighting  matrix  R  (M  x m) 
is  entered,  followed  by  the  state  weighting  matrix  Q  (N  *  N) . 
If  and  only  if  the  transient  response  of  the  gains  was 
requested,  by  assigning  non-zero  values  to  tQ ,  tf  and  n 
points,  the  terminal  boundary  condition  matrix  P(tf)  (N x N) 
is  given  last. 

(3)  Filter  Option  Input 

The  first  card  of  this  portion  of  the  data 
deck  indicates  a  Kalman  filter  problem  by  the  letter  F 
punched  in  column  one.   As  for  the  control  option  input, 
the  time  interval  and  number  of  points  of  the  filter  gain 
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matrix  transient  response  to  be  output  are  also  entered  on 
that  first  card,  if  and  only  if  the  transient  response  is 
desired.   Next,  the  measurement  noise  covariance  matrix 
R  (L  x  L)  and  the  random  input  covariance  matrix  0  (M *  M) 
are  entered,  one  row  at  a  time.   Finally,  if  and  only  if  the 
transient  filter  gain  solution  was  requested  by  assigning 
non-zero  values  to  tQ,  t.  and  NPOINT   the  initial  boundary 
condition  matrix  P(tQ)  (N x n)  is  given. 

(4)   Problem  Termination  Card 

The  user  may  ask  for  several  different  com- 
puter solutions  of  the  same  basic  problem  by  stacking  the 
control  input  cards  for  transient  response  and  the  control 
input  cards  for  steady-state  solution,  or  the  filter  input 
cards  for  steady-state  solution  and  the  filter  input  cards 
for  transient  response.   Termination  of  a  given  problem  is 
indicated  by  a  blank  card.   As  usual,  many  problems  can  be 
executed  under  the  same  run  by  placing  the  complete  data 
decks  one  on  top  the  other. 

The  following  input  format  table  summarizes 
the  above. 


Entry 

1 
Basic 


Input  Description 

Problem  identification, 
order  of  the  plant  (N  <_  10) 
number  of  control  inputs 
(M  <  10)  , 

number  of  measurements 
(L  <  10)  . 


Format 


12 


Columns  Used 


5A4, 

1-20, 

12, 

21-22, 

12, 

23-24, 

25-26 
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Entry 

2 

Basic 

3 
Basic 

4 
Basic 


Control 
Option 


Control 
Option 

7 

Control 
Option 

8 

Iff 

NPOINT 
*    0 

Control 
Option 


Filter 
Option 

10 

Filter 
Option 

11 

Filter 
Option 


Input  Description 

Plant  matrix  a  (N  x N)  (one  row 
per  card  for  N  _<  8;  one  row 
per  two  cards  for  N  >  8) 

T 
Distribution  matrix  B   (M  x  n) 

(one  row  per  card  for  N  <_   8; 

one  row  per  two  cards  for  N  >  8) 

Measurement  matrix  C  (L  x  N) 
(one  row  per  card  for  N  <_   8; 
one  row  per  two  cards  for  N  >  8) 


Letter  C, 
initial  time  t, 
final  time  tf, 
number  of  points 


•0' 


(NPOINT) 


Control  weighting  matrix  R  (M  x M) 
(one  row  per  card  if  M  <  8;  one 
row  per  two  cards  for  M  >  8) 

State  weighting  matrix  Q  (N  x  n) 
(one  row  per  card  for  N  <_  8; 
one  row  per  two  cards  for  N  >  8) 

Terminal  boundary  matrix  P(tf) 
(N  x  n)  (one  row  per  card  for 
N  <_   8;  one  row  per  two  cards 
for  N  >  8) 


Letter  F, 

initial  time 

final  time  tf, 

number  of  points  NPOINT 


•o' 


Measurement  noise  covariance 
matrix  R  (L  x  l)  (one  row  per 
card  for  L  _<  8;  one  row  per 
two  cards  for  L  >  8) 

Random  input  covariance  matrix 
Q  (M  x  m)  (one  row  per  card  for 
M    8;  one  row  per  two  cards 
for  M  >  8) 


Format 
8E10.0 

8E10.0 

8E10.0 


8E10.0 


8E10.0 


8E10.0 


Columns  Used 

1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


Al, 

1, 

F10.3, 

11-20, 

F10.3 

21-30, 

13 

31-32-33 

8E10.0 

1-10,  11-20, 

21-30,  etc. 

1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


Al, 

1, 

F10.3, 

11-20, 

F10. 3, 

21-30, 

13 

31-32-33 

8E10.0 

1-10,  11-20, 

21-30,  etc. 

1-10,  11-20, 
21-30,  etc. 
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Entry   Input  Description 


12 

Iff 

NPOINT 

Filter 
Option 

13 


Initial  boundary  value  matrix  P(tn) 
(N  *  N)  (one  row  per  card  for 
N  £  8;  one  row  per  two  cards 
for  N  >  8) 


(blank  card)  (indicates  problem 
termination) 


Format 
8E10.0 


Columns  Used 

1-10,  11-20, 
21-30,  etc. 


8E10.0    (blank) 


Table  XVI  -  Input  Format  Table  for  RICATI 

b.  Output 

T 
The  problem  identification  and  the  A,  B   and  C 

matrices  are  listed  for  reference.   Then  the  option  requested 

is  indicated  and  the  R,  Q  and  P  matrices  are  printed.   Finally, 

"steady-state  solution"  or  "transient  response"  is  printed, 

followed  by  the  gain  matrix  Gr  or  G  . 

~f    ~c 

c.  Examples 

Two  problems  are  worked  out  to  illustrate  the  use 
of  this  subprogram. 

(1)   Example  One 

In  the  first  case  we  assume  the  plant 


x1(t)      =  x2(t) 


x2(t)   =  u(t) 


and  wish  to  determine  what  must  the  control  gains  be  to 
minimize  the  performance  measure 


204 


J   =    /  faxiXl  (t)  +  q22X2  (t)  +  Ru  (t)]  dt 


where  the  weighting  factors  are  q..  =  4.0,  q   =  0  and 

R  =  50.   The  control  option  is  used.   The  elements  necessary 

for  the  data  deck  are: 


A  = 


0 

Lo 


B" 


=   [0 


1] 


C   =   [0 


0] 


(Note  that  C  is  not  used  in  the  calculations  but  must  be 
included  since  the  input  table  requires  it.) 

R  =   50. 


Q  = 


4.0 
LP 


Both  the  steady-state  and  transient  solution  are  desired. 
For  the  transient  part  of  the  problem,  tQ  =  0.0,  tf  =  10.0 
and  NPOINT  =  020  are  selected  with  the  initial  condition 
P(tf)  =  0. 

The  control  and  data  cards  are  then 
//  (standard  OS  JOB  card) 
//  -  EXEC -LINCON 
//I^NK .  SYS  IN  /vDD  -* 
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^INCLUDE-SYSLIB  (RICATI) 

/* 

//GO.SYSIN~DD~* 

RICATI  CONTROL  TEST   020101 

0.0     1.0 

0.0     0.0 

0.0     1.0 

1.0     0.0 

C 

50. 

4.0     0.0 

0.0     0.0 

C       0.0  10.0      020 

50. 

4.0     0.0 

0.0     0.0 

0.0     0.0 

0.0     0.0 

(blank  card) 

/* 

The  solution  in  Fig.  3-42  shows  the  requested  steady-state 

and  transient  response. 

(2)   Example  Two 

The  second  problem  is  to  find  the  optimal 
Kalman  filter  gain  matrix  for  the  following  system: 


0     1  0 

x(t)   =  x(t)  +  w(t) 

0    -4.6    ~         0.1 
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OPTIMAL    CONTROL/KALMAN    FILTER    PROGPAM 
PROBLEM    IDENTIFICATION   -    RICATI    CONTROL    TEST 

•*••••••»•■•«•*»••*»••*»*»••»»♦»♦»♦*»***»*•»»* 

THE    A    MATRIX 


0.0 
O.C 

THE  8  MATRIX 
0.0 

THE  C  MATRIX 
1.000000000    00 


1.000000000  00 
0.0 


1.000000000  00 


0.0 


ft******************************************** 
•**  CONTROL  OPTION  *** 

THE  R  MATRIX 

5.030030000   01 

THE    0   MATRIX 


4. 000030000  00 
0.0 


0.0 
0.0 


STEAOY    STATE    SOLUTION. 

GAINS 
2.828426140-01  7.521196010-01 

•**    CONTROL    OPTION   *•• 

THE    R    MATRIX 

5.000000000  01 

THE    0    MATRIX 


4.000000000   00 
0.0 

0.0 
0.0 

INITIAL    CONOITIONS 

0.0 
0.0 

0.0 

0.0 

•••••«••»•»*♦»•»•«»•»»»»»»»»**»*♦»**•♦«*«♦* 

TIME    -.                 1, 
GAINS 
0.0 

.20COOO0OG 
0.0 

01 

THE    ».                 1. 
GAINS 
l.*0324255D-02 

.14CO0OO10    01 

5.472364400- 

■03 

TIME     ».                   1 
CAINS 

5.62  3951600-02 

.08C0OOG30    CI 

4.438778840- 

•02 

TI«E    -.                 1. 
GAINS 
1.214259300-01 

.02C000C40 

CI 

1.437358900- 

•01 

TIME    ».                 9, 
GAINS 
1.934566330-01 

.60C000500   CO 

3.028165130- 

-01 

TIME   .,                9 
GAINS 
2.49254 8240-01 

,000000630 

CO 

4.7759S8020-01 

OMM> 

2.7/J07295P-01 

Tl"E    -.  i 

GAI"S 
2.831003900-01 

TIME    ..  1 

GAINS 
2.798658030-01 

THE    .,  « 

GAINS 
2.755197080-01 

TIME    »,  t 

GAINS 

2.  73232  1230-01 

TIME    «,  5 

GAINS 
2.731831320-01 

TIME    •,  <, 

GAtflS 
2.746/21080-01 

TIME    -.  4 

GAINS 
2.76758  9630-01 

THE    «.  3 

GAINS 
2.  7(1  784  1950-01 


TIME    «, 
GAINS 
2.80406710C-01 

TIME    », 
GAINS 
2.415364860-01 

TIME    », 
GAINS 
2.822307670-01 

TIME    «, 
GAINS 
2.826049710-01 

TIME  ». 
GAINS 
2.82  7759260-01 

TIME  «. 

GAINS 

2.828353740-01 


3. 


2. 


1. 


1. 


6. 


2. 


•4CIICJ7M!  00 

6.1366*8570-01 
.80030086  0  00 

6.919276840-01 
.20COC1000    CO 

7.261927910-01 
•60C001130  CO 

7.37C992770-01 
.C00001250  OC 

7.38  9650480-01 
.4CC001360  CO 

7.389602520-01 
.80C001500  CO 

7.3969C5890-01 
.20000163C  00 

7.415017C80-01 
>60000175C  CO 

7.439091700-01 
OOC001880    CO 

7.463329320-01 
4000O7CO0    OC 

7.483850950-01 
800002130    00 

7.499113800-01 
20C002250    CO 

7.5052  77650-01 
000023780-C1 

7.515369650-01 
503J95C8C-06 

7.518635080-01 


Figure  3-42   Control  Option  Test  for  RICATI 
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The  random  input  w(t)  is  white  noise  with  variance  Q  =  10. 
The  observed  variable  is  given  by 

z(t)   =   [1     0]  x(t)  +  v(t) 

where  v(t)  is  also  white  noise  with  variance  R  =  10 
From  the  above  it  is  easy  to  extract  the  data  necessary  to 
solve  the  problem  by  the  use  of  RICATI.   Writing  down  the 
elements  one  gets : 


A  = 


1 
-4.6 


B' 


=   [0 


.1] 


C   =   [1 


0] 


R   =   10 


-7 


Q   =   10 


The  initial  condition  matrix  P(tQ)  is  chosen  to  be 


?<V   - 


The  time  is  specified  as  being  tQ  =  0.0  and  t-_  -  0.5  and  a 
number  of  points  to  be  output  is  NPOINT  =  10.   The  computer 
cards  to  solve  both  for  the  transient  and  steady-state  are 


, 
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//  (standard  OS  JOB  card) 
// A  EXEC^LINCON 
//LINK.SYSIN^DD,,* 
A  „  INCLUDE ^SYSLIBfRICATI) 
/* 

//GO.SYSIN^DD,,* 
RICATI  FILTER  TEST   020101 
0.0        1.0 
0.0        -4.6 
0.0        0.1 
1.0        0.0 

F  0.0        0.5        010 

0.0000001 
10. 
F 

0.0000001 
10. 

/* 

Results  presented  in  Fig.  3-4  3  indicate  that  the  algorithm 
used  by  the  computer  to  find  the  steady-state  gains  is  not 
good  enough  for  the  problem.  The  transient  response  final 
values  are  used  as  steady  state  gains. 

8.   Discrete  Time  Kalman  Filter  (Kalman) 

This  double-precision  subprogram  is  used  to  calculate 
the  discrete  Kalman  filter  gain  matrix  G,  .   The  theory  of 
the  discrete  Kalman  filter  can  be  obtained  from  many  textbooks 
and  articles  and  is  not  reproduced  here.   For  example  see  [10] 
and  [11] . 
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OPTIMAL    CCNIAUL/KALMAN    MltU    PQIf.paM 
PROBLEM    IDENTIFICATION   -    RICATI    FILTER   TEST 


THE    A    MATRIX 

0.0 
0.0 

l.OOOOCOCCO    00 
-4.60000000C   00 

THE    a    MATRIX 

0.0 

1.000000000-01 

THE    C    MATRIX 

l.OOOOOOOUO    00 

0.0 

••«    FILTER    OPTION    ••* 

THE  R  MATRIX 
1. 000000000-07 

THE  0  MATRIX 
1.000000000   01 

INITIAL   CONOITIGNS 

0.0  0.0 

0.0  0.0 

•••a***************************************** 

TIME    -,  0.0 

GAINS 
0.0  0.0 

TIME    ..  4.99S998960-02 

GAINS 
1.717204510    01  6.858276780    02 

Tl*E    a,  9.999997910-02 

GAU.S 
4.036759960    01  7.822256930   02 

TIME    ».  I. 499999690-01 

GAINS 
3.9*0694580    01  8.080164440    02 

TIME    »,  1.999999530-Cl 

GAINS 
4.037878530    01  8.  14 8J4877D   0? 

TIME    ».  2.499999480-01 

GAINS 
4.0^5261820    01  8.142^46580    02 

TIMF    -.  2.999999370-Cl 

GAINS 
4.035756700    01  8. I<f36e2460    02 

THE    •«  3.49999927C-01 

GAINS 
4.035728330   01  8.143547270    02 

TIME    ».  3.99999917C-01 

GAINS 
4.035731320    01  8.143565030   02 

TI««E    «.  4.499999C60-C1 

GAINS 
4.035731320   01  8.143563460   02 

TIME    «,  4. 999998960-01 

GAINS 
4.035731300   01  8.1435636G0  02 

**••*•*  •  «*_••****«•*•*******  «•***•♦****,*>**•*« 

**•    FILTER    OPTION    **• 

THE  R  MATRIX 
1.000000000-07 

THE    0    MATRIX 

1.000000000   01 

UNABLE    T3    FINO    STEAOT-STATE    GAINS 
PLEASE   USE    TRANSIENT    RESPONSE   OPTION 


Figure  3-43   Filter  Option  Test  for  RICATI 


210 


The  following  block  diagram,  definitions  and  equations 
are  nonetheless  included  to  summarize  the  ideas  and  clarify 
the  notation  adopted  in  this  discussion. 


wk      => 


Lf*8 


5cfl 


^>     DELAY 


*  c 


3c 


><* 


H 


c 


5c|k 


5c|k-l 


3c|k-l 


♦  < 


o 


Fig  3-44   Discrete  Kalman  Filter  Block  Diagram 

From  the  diagram,  one  gets  the  discrete  time  system 
state  equation 

*k+1  =  t^  +  l^ 
and  the  measurement  equation 
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z,   =   H  x,  +  v, 

~k     ~  ~k    ~k 


Each  element  can  be  briefly  defined  and  the  matrix 
dimensions  noted  as: 


x,  :   state  vector  (N  x  1) 
~k 


<£   :   transition  matrix  (N  x  n) 
w,  :   system  random  input  (L  x  1) 
r   :   distribution  matrix  (N  x L) 


z.  :   measurement  vector  (M x  1) 
H   :   observation  matrix  (M  x n) 


v,  :   measurement  noise  (M x  1) 
~k 


G,  :   gain  matrix  (N  x M) 
The  problem  is  to  minimize 


Jl   =   E[(xk  ~  ?k|k)T  (*k  "  *k|k)] 


4 
with  respect  to  G,  .   Note  that  J-  is  a  scalar. 


lJ,  actually  is  the  trace  of  the  cost  function 
£   "   E[(?k  '  *k|k}  (*k  "  ?k|J] 


where  J  is  a  (N  x N)  matrix. 
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The  solution  to  the  problem  is 


5k    =    ?k|k-i  ?  [5pkik-i?    +  V 


-l 


(i) 


?k|k    =    [l  -  ?k?]  ;k|k.i 


(2) 


pk+iik    -    $  ?klk  *    +  9 


(3) 


where 


*k|k    =    *k|k-i  +  5k[?k  "  ?^klk-i] 


(4) 


and 


xk|k-l   =   J  xk-l|k-l 


(5) 


given  the  initial  conditions 


x0|-l   =   E[?(0)] 


and 


?ol-i  =  E[(?  -  ?ol-i>  ] 


The  terms  associated  with  the  above  equations  are 
defined  as 


P  i 
~k  k  ' 


(N  x  N)  matrix  of  the  covariance  of  error  of 
the  estimate  at  k  given  observations  at 
times  up  to  and  including  time  k. 
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?k|k-l  :   (N  x N)  matrix  of  the  covariance  of  error  of 

the  one-step  prediction  at  k  given  observations 
at  times  up  to  and  including  time  (k-1) 

R      :   (M  x  N)  covariance  matrix  of  the  measurement 
noise 

Q      :   (N  x  n)  covariance  matrix  of  the  random 
input 


The  matrix 


Q  =   T  E(W,W,T)  rT 


is  computed  from  the  parameters  r   (L *  N)  and  E[W,W  T]  (L  * L) 
The  purpose  of  the  subprogram  KALMAN  is  to  solve  the 
recurrence  relations  (1) ,  (2)  and  (3)  for  a  specified  number 
of  iterations  N  and  print  the  filter  gain  matrix  G,  as  a 
function  of  k. 

a.   Input 

Since  many  problems  are  encountered  where  the 
designer  must  compensate  for  time-varying  environment  by 
letting  the  covariance  of  the  observation  noise  be  variable, 
it  was  decided  to  permit  the  user  to  define  the  R  (M  x  M) 
matrix  with  an  external  subroutine.   The  subprogram  KALMAN 
thus  is  accessible  under  Mode  Two  of  operation  only.   Also 
note  that  the  subprogram  is  double-precision. 

The  first  input  to  be  entered  is  the  covariance 
of  the  observation  noise  via  the  double-precision  subroutine 
RDEF(R,NP,M)  performed  by  the  main  program  where  M  is  the 
order  of  the  matrix.   The  parameters  NP  and  M  are  directly 
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available  from  the  main  program  and  must  not  be  assigned  any 
value  here,  i.e.,  leave  them  as  NP  and  M.   The  subroutine 
is  then 

SUBROUTINE  RDEF(R,NP,M) 

IMPLICIT  REAL* 8   (A-H,  0-Z) 

DIMENSION  R(20/20) 

FORTRAN  statements  defining 

the  R  matrix  (see  example  part  c.) 

RETURN 

END 

Next  the  data  deck  is  punched.   The  problem 
identification,  the  order  of  the  system  N,  the  dimension  of 
the  random  input  vector  L  and  the  number  of  outputs  M  are 
given  on  the  first  card  and  are  followed  by  the  <j>  (N  x  N)  matrix,  the 
rT  (L x n)  matrix,  the  E[WWT]  (L x l)  matrix,  the  H  (M  x n) 
matrix  and  the  initial  condition  matrix  PQ 1  -  (N x n)  in 
accordance  with  the  input  format  table  shown  below. 


Entry     Input  Description  Format 


Columns  Used 


1      Problem  identification,  order 
of  the  system  (N  <_  10)  , 
dimension  of  the  random  input 
vector  (L  <_   10)  ,  number  of 
measurements  (M  <  10) 


5A4,  312   1-20,  21-22, 
23-24,  25-26 


$  (N x n)  matrix  (one  row  per     8E10.0 

card  for  N  _<  8;  one  row  per 

two  cards  for  N  >  8) 

T 
r   (L x n)  matrix  (one  row  per     8E10.0 

card  for  N  <_   8;  one  row  per 

two  cards  for  N  >  8) 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 
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Entry   Input  Description 

T 

4  E [WW  ]  (L  x  L)  matrix  (one  row 

per  card  for  L  £  8;  one  row 
per  two  cards  for  L  >  8) 

5  H  (M  *  N)  matrix  (one  row  per 
card  for  N  _<  8;  one  row  per 
two  cards  for  N  >  8) 

6  Number  of  time  points  to  be 
performed  (NP) 

7  ?n|-l  ^N  X  N^  matr:i-x  (°ne  row 
per  card  for  N  <_  8;  one  row 
per  two  cards  for  N  >  8) 


Format    Columns  Used 

8E10.0     1-10,  11-20 
21-30,  etc. 


8E10.0 


8E10.0 


1-10,  11-20, 
21-30,  etc. 


1-10 


8E10.0     1-10,  11-20, 
21-30,  etc. 


Table  XVII  -  Input  Format  Table  for  KALMAN 

b.  Output 

The  problem  identification,  the  discrete  system 

T 
<$>   matrix,  the  transpose  of  the  gamma  matrix,  the  E  [WW  ] 

matrix  (listed  as  the  W  matrix  on  the  printout) ,  the  measure- 
ment matrix  H,  the  initial  value  of  the  observation  noise 
covariance  matrix  (at  NP  =  0)  and  the  initial  condition  matrix 
are  listed  for  reference.   Then  the  filter  gain  matrix  is 
printed  as  a  function  of  the  time  index  k,  from  k  =  0  to 
k  =  NP. 

c.  Example 

It  is  desired  to  estimate  position  and  velocity 
from  noisy  position  measurements  only.   The  system  equations 
are 


x1(k+l) 


x2(k+l) 


1 

.5~ 

x^kf 

+ 

".125 

0 

1  m 

x9(k) 

.5 

w(k) 
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z(k)   =   [1    0] 


xx(k) 


x2(k) 


+  v(k) 


where  the  perturbation  acceleration  w(k)  has  a  root  mean- 
square  magnitude  of  2  meters  per  second. 

From  the  above  information/  one  can  see  that 


*  = 


1     .5 


0     1 


[.125     .5] 


E[WWT] 


=  mean-square  magnitude  of  the 
perturbation  acceleration 

=   4. 


The  matrix  Pfl i  .  is  assumed  to  be 


P 
-0-1 


10     0 
0     10 


and  the  covariance  of  the  observation  noise  is  assumed  to  be 


R  = 


4  +  (-  |)  (NP) 


for  0  <_  NP  <_   10 
for  10  <  NP 
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The  number  of  time  points  to  be  computed  is  chosen  to  be  20 
and  the  following  computer  card  deck  is  set  up: 
//  (standard  OS  JOB  card) 
//  ~  EXEC^LINCONF 
//FORT . SYS IN  „DD  * * 

SUBROUTINE  RDEF(R,NP,M) 

IMPLICIT  REAL*8  (A-H,0-Z) 

DIMENSION  R(20,20) 

DO   1   1=1, M 


DO   1   J=1,M 

IF(NP.LE.IO)    R(I,J)=4 

1 

IF(NP.GT.IO)   R(I,J)=4. 

RETURN 

END 

/* 

//LINK 

.SYSIN^DD^* 

_ INCLUDE ^SYSLIB (KALMAN) 

^ ENTRY A  KALMAN 

/* 

//GO.SYSIN^DD^* 

KALMAN 

TEST         020101 

1.0 

0.5 

0.0 

1.0 

0.125 

0.5 

4.0 

1.0 

0.0 

10.0 

0.0 
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DISCRETE  TIHg  KALMAN  FILTER  PROGRAM 
PPC8LEM  IDENTIFICATION  =  KALMAN  TFST 


The  PHI  MATRIX 

l.CIOCOGOOD  00 
0.0 

THE    GAMMA    MATRIX 
1.250CO000D-O1 

THE    W    MATRIX 
4.000000000    00 

THE    H   MATRIX 
I.  00000000 C   00 

THP    R     MATRIX 
5.0O003000C   00 

INITIAL    CCNOITICNS 

l.OOOOOOOOD  01 
O.O 


5.CCCCCCCCD-01 
l.OOOOOOOCD  00 


5.0OC00C00O-01 


0.0 


0.0 
l.OOOOOOOOD  01 


»■»»•■»*•«••»»..».*»■». •».«.».. ........ «a«... 


K     *  0 

GAINS 
6.666666670-01 

K    *  I 

GAINS 
6. 274944570-01 


K    =         2 

GAINS 

5.945043990-01 


K  =    3 

GAINS 

6.249582400-01 

K  ■    4 
GAINS 
5.70600231D-01 

K   «         5 

GAINS 
5.474077150-01 

K    *         6 
GAINS 
5. 212203260-01 

K    =         7 
GAINS 
5.121724200-01 


0.0 

5.587582150-01 

5.952565580-01 

5.28080571C-01 

A. 261785710-01 

3.829295070-01 

3.580889810-01 


3. 523912470-01 
3.506715420-01 
3.515716890-01 
3.518606460-01 
3.520437990-01 
3.519618380-01 
3.516521610-01 
3.517778920-01 
3.517430620-01 

Figure  3-45   Discrete  Time  Kalman  Filter  Test 


k   =   a 

GAINS 
5.064088510-01 

K  »    9 
GAINS 
5.05603350C-01 

K    *      10 

GAINS 
5.051432270-01 

K    =       11 

GAINS 
5.053009330-01 

<    =       12 
GAINS 
5.C530D983D-01 

K   =       13 
GAINS 
5.052559030-01 

K   =      14 
GAINS 
5.052039230-01 

K   =      15 
GAINS 
5.05166997D-01 


K   =      16 
GAINS 
5. 051475730-01 

K    =       17 
GAINS 
5. 051398560-01 

K    =       18 
GAINS 
5.05137730D-O1 

K  =   19 

GAINS 
5.051374380-01 

K  =   20 
GAINS 
5.05137561D-01 


3. 517321640-01 
3.517310550-01 
3.517321670-01 
3. 517329150-01 
3. 517330250-01 
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0.0     10.0 

/* 

The  results  of  this  run  are  shown  in  Fig.  3-45. 

9.   Discrete  Time  Linear  State  Regulator  (STREG) 

This  double-precision  subprogram  is  used  to  compute 
the  discrete  linear  regulator  feedback  gains  F(NS-K).   The 
discrete  linear  regulator  problem  can  be  stated  as  [12] : 
given  a  time- invariant  discrete  system  represented  by 

x(k+l)   =  Ax(k)  +  Bw(k) 

where  the  states  and  controls  are  unconstrained,  find  an 
optimal  control  u*(x(k),  k)  that  minimizes  the  performance 
index 


J   =   i  xT(NS)  H  x(NS) 


+  j     I    [xT(k)  Q  x(k)  +  wT(k)  R  w(k)] 


2  k=0  - 


where 


x(k) :  state  vector  (N  *  1) 

A    :  coefficient  matrix  (N  x  N) 

B    :  distribution  matrix  (N  x  M) 

w(k):  system  input  vector  (M *  1) 
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J   :   performance  index  (scalar) 

H   :   real  symmetric  positive  semi-definite  matrix 
(N  x  N) 

Q   :   real  symmetric  positive  semi-definite  matrix 
(N  x  n) 

R   :   real  symmetric  positive  definite  matrix  (M  *  M) 
NS  :   fixed  integer  greater  than  0  (number  of  stages) 

After  solving  the  problem,  one  realizes  that  the 
optimal  feedback  gains  can  be  evaluated  by  solving  the 
following  two  equations  only: 


F(NS-K)   =   -[R+ BTP(K-1)B]~1  x  [BTP(K-1)A]  (1) 


P(K)   =   [A  +  BF(NS  -  K)  ]TP(K-1)  [A  +  BF  (NS  -  K)  ]         (2) 
+  FT(NS  -  K)RF(NS  -  K)  +  Q 


where  F (NS  -  K)  is  the  feedback  gain  matrix  and  P(0)  =  H. 

The  STREG  subprogram  determines  the  F(NS-K)  matrix 
for  0  <  NS  <_  999  as  K  varies  from  one  to  NS .   It  also  gives 
the  final  value  of  the  real  symmetric  P(K)  matrix,  i.e., 
P(NS).   From  these  results  the  user  can  design  the  optimal 
discrete  system 

x(k+l)   =   A  x(k)  +  B  w(k) 

w(k)   =   F(k)  x(k) 
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where  k  =  NS  -  K  (a  block  diagram  representation  of  the  system 
is  shown  in  fig.  3-46).   Note  that  P(NS)  is  presented  so  one 
can  also  calculate  the  minimum  cost  for  the  NS-stage  process 
given  some  initial  state  x  using  the  relation  [17] 


o,N  ,o 


1    T 

±  X    P(NS)  k 

&    ~o        _o 


a.   Input 

The  first  input  data  card  consists  of  the  problem 
identification,  the  A  matrix  dimension  (N  <_  10)  and  the  number 
of  inputs  (M  <_   10)  .   Then  the  A  (N  x  n)  ,  BT  (M  *  N)  ,  H  (N  x  N)  , 
Q  (N  x  N)  and  R  (M  x  M)  matrices  are  presented  one  row  at  a  time. 
Finally  the  number  of  stages  (0  <  NS  <_  999)  is  given.   The 
following  input  format  table  further  describes  the  required 
data  cards. 


Entry      Input  Description 

1  Problem  identification, 
system  order  (N  <_  10)  , 
number  of  inputs  (M   10) 

2  A(N  x  n)  matrix  (one  row  per 
card  for  N  <_  8;  one  row  per 
two  cards  for  N  >  8) 

T 

3  B  (M  x  n)  matrix  (one  row  per 

card  for  N  <^  8;  one  row  per 
two  cards  for  N  >  8) 

4  H  (N  x  n)  matrix  (one  row  per 
card  for  N  <_  8;  one  row  per 
two  cards  for  N  >  8) 

5  Q  (N  x  N)  matrix  (one  row  per 
card  for  N   8;  one  row  per 
two  cards  for  N  >  8) 


Format    Columns  Used 

5A4,  212   1-20,  21-22, 
23-24 


8E10.0 


8E10.0 


8E10.0 


1-10,  11-20, 
21-30,  etc. 


8E10.0     1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 
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k  =  NS  -  K 


x(k) 


w(k) 


F(k) 


C 


Figure  3-4  6   Discrete  Linear  Regulator  Block  Diagram 
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Entry 
6 


Input  Description  Format 

R  (M x  M)  matrix  (one  row  per     8E10.0 
card  for  M   8;  one  row  per 
two  cards  for  M  >  8) 

Number  of  stages  for  the         13 
process  (0  <  NS  <  999) 


Columns  Used 

1-10,  11-20, 
21-30,  etc. 


1-3 


b.  Output 

The  problem  identification,  the  discrete  system 
A  matrix,  the  transpose  of  the  distribution  matrix  and  the 
H,  Q  and  R  matrices  are  listed  for  reference.   Then  the  feed- 
back gain  matrix  F (NS  -  K)  is  printed  as  a  function  of  the 
backward  time  index  (NS  -  K)  for  K  =  1  to  K  =  NS.   Finally,  the 
real  symmetric  P(NS)  matrix  is  given. 

c.  Example 

Given  the  linear  discrete  system  [12] 


x(k+l)   = 


0.9974 
-  .1078 


0.0539 
1.1591 


x(k) 


0.0013 
0.0539 


w(k) 


the  feedback  gain  matrix  F(NS-K)  is  to  be  determined  which 
minimizes  the  performance  measure 


N-l 


J   =   |  I    [0.25  xx2(k)  +  0.05  x22(k)  +  0.05  w2 (k) ] 


k=0 
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The  data  are  then: 


A  = 


0.9974     0.0539 
-  .1078     1.1591 


B    =   [0.0013     0.0539] 


H   =   0 


Q  = 


0.25    0.0 
0.0      0.05 


R  =   0.05 

Order  of  the  system,  N  =  2 

Number  of  inputs,  M  =  1 

For  this  problem  NS  is  chosen  to  be  200  and  the 
computer  control  and  data  cards  are 
//  (standard  OS  JOB  card) 
//.EXEC.LINCON 
//LINK.SYSIN.DD.* 
..INCLUDE  SYSLIB(STREG) 
/* 
//GO. SYS IN. DD.* 
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STREG   TEST     0201 
0.9974     0.0539 


-.1078 

1.1591 

0.0013 

0.0539 

0.0 

0.0 

0.0 

0.0 

0.25 

0.0 

0.0 

0.05 

0.05 

200 

/* 

The  results  presented  in  fig.  3-4  7  show  that 

F(NS  =  K)  approaches  a  constant  matrix  F  as  K  -*■   200. 

10.   Multiple-Input  Multiple-Output  Control  System 
Decoupling  (MIMO) 

This  subprogram  is  used  to  determine  a  feedback  con- 
control  law 


u(t)   =   G  r(t)  +  F  x(t) 


If  a  system  is  completely  controllable  and  time  invariant, 
H  =  0,  and  R  and  Q  are  constant  matrices  then  [12] 

F(NS-K)   ■*■   F  (a  constant  matrix)   as   NS  -»■  « 
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OISCRETE  LINEAR  STATE  REGULA7CR  PROGRAM 
PROBLEM  IDENTIFICATION  =  STREG  TEST 


THE  A  MATRIX 

9.97400C00D-01 
-1.07800000C-01 


5.390CCCCCD-02 
1.1591OC000   00 


THE    9    MATRIX- 

1.30000000C-03 

5.39CCC000O-O2 

ThE    H    MATRIX 

0.0 
0.0 

0.0 
0.0 

THE    0    MATRIX 

2.5OOCC0OOO-O1 
0.0 

0.0 
5.0CC0CCCC0-02 

ThE    R    MATRIX 
5.00000GOOO-02 
i  **«****«• ********************************* 


K    *     199 
GAINS 
0.0 

K    »    198 
GAINS 
-6.707257330-04 

K    =     19  7 
GAINS 
-6.932*4869D-;03 

K  =  196 
GAINS 
-1.664341000-02 

K    *    195 
GAINS 
-2.637895110-02 

K    a    194 
GAINS 
-3. 12184177 C-02 

K  =  193 
GAINS 
-2.  *3 8 35*940-02 

N  *  192 

GAINS 
-2.385251940-04 

K    a    191 
GAINS 
4.96129417D-02 

K    *    190 
GAINS 
1  .297456460-01 

K    *    189 
GAINS 
2.*175*156D-01 

K    =    188 
GAINS 
3.826991590-01 

K    =    187 
GAINS 
5.^52560770-01 

K  =  186 
GAINS 
7.I914J314D-01 

K  *    165 
GAINS 
8.932*19290-01 

K  -     184 
GAINS 
1.057620300  00 


0.0 
-6.26*331670-02 
-1.4739*4140-01 
-2.612811310-01 
-4.122C67C50-01 
-6.08210446C-01 
-8.561395980-01 
-1.159728390  00 
-1.51739€950  00 
-1.9205261*0  00 
-2.353169*30  00 
-2.79296C*90  00 
-3.2200*2300"  Or-  -' 
-3.6113G956C  00 
-3.953952950  00 
-*. 2*1576750  00 


K  =   14 
GAINS 
-5.522296540-01 

K  =   13 
GAINS 
-5.522296540-01 

K  =   12 
GAINS 
-5.52229654D-01 

K  =   11 
GAINS 
-5.52229654D-01 

K  =   10 
GAINS 
-5.52229654D-01 

K  =    9 
GAINS 
-5.52229654D-01 

K  =    8 
GAINS 
-5.52229654D-C1 

K  =    7 
GAINS 
-5.52229654C-01 

K  =    6 
GAINS 
-5. 522296540-01 

K  =    5 
GAINS 
-5.522296540-01 

K  =    4 
GAINS 
-5.52229654D-01 

K  =    3 

GAINS 
-5.522296540-01 

K    =         2 
GAINS 
-5.522296540-01 

K  =    1 
GAINS 
-5.522296540-01 

K  =    0 
GAINS 
-5.522296540-01 


-5.96901509C  00 
-5^69015090  00 
-5.969015C9C  00 
-5.969015C9D00 
-5.969015C9D  00 
-5.969G15C90  00 
-5.96S015C9D  00 
-5.969015C90  00 
-5.969015C9D  00 
-5.969015C90  00 
-5.969015C90  00 
-5.969C1E09D  00 
-5.969015090  00 
-5.969015C9D  00 


-5.969015C90  00 

******»*k *********  **««**«***«.*********  *^***** 


ANO   TH=    P1200)    MATRIX    IS 

1.652262630  01 
1.0173b*13D  00 


1.01736418C    00 
6.5C99J6480    00 


Figure  3-47   Discrete  Linear  State  Regulator  Test 
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for  an  Nth  order  system 


x(t)   =  A  x(t)  +  B  u(t) 


y(t)   =  c  x(t) 


such  that  the  control  system  is  decoupled ,  i.e.,  the  i    input 
ri(t)  affects  only  the  i   output  y. (t) .   Notice  that  the 
subprogram  applies  only  if  the  number  of  inputs  is  exactly 
the  same  as  the  number  of  outputs.   The  computer  calculates 
both  the  feedback  gain  matrix  F  and  the  command  input  gain 
matrix  G.   The  user  only  has  to  feed  in  the  coupled  system 
matrices  A,  B  and  C  and  specify,  arbitrarily,  the  desired 

■Hi 

closed-loop  poles  of  each  i    transfer  function  Y. (s)/R. (s) . 

The  theory  regarding  the  algorithm  used  for  decoupling 
is  not  presented  here.   For  this,  the  reader  is  referred  to 
[1] .   Sufficient  information  is  included,  however,  to  illus- 
trate the  concepts  and  to  permit  easy  use  of  the  subprogram. 
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a.   Input 

The  problem  identification,  the  system  order  (N 
less  than  or  equal  to  ten)  and  the  number  of  inputs  and  outputs 
(M  less  than  or  equal  to  ten)  are  given  on  the  first  card 
according  to  the  format  shown  on  the  input  format  table  for 

MIMO.   Then  the  A  matrix  (N*N)  is  entered,  followed  by  the 

T 
B  matrix  (MxN)  and  the  C  matrix  (MxN) ,  one  row  at  a  time. 

Note  that  B  is  transposed  and  the  number  of  inputs  must  equal 

the  number  of  outputs. 

Next  the  option  card  is  punched.   If  the  option 
is  blank,  the  phase  variable  form  of  the  decoupled  system  is 
obtained  and  the  subprogram  returns  to  begin  another  problem. 
If  options  P  or  F  are  selected,  the  control  law  u(t)  necessary 
to  achieve  a  decoupled  system  with  closed-loop  poles  at  loca- 
tions specified  by  the  user  is  determined.   If  option  =  F, 
the  next  cards  give  the  desired  poles  of  Y, (s)/R, (s) . 

According  to  the  convention  established  before, 
if  option  F  is  selected  the  real  part  of  a  root  is  entered 
as  being  positive  if  it  lies  in  the  left-half  plane,  negative 
if  in  the  right-half  plane  and  only  the  positive  imaginary 
part  of  a  complex  pair  is  given  (see  p.    ) .   If  option  P  is 
selected,  the  coefficients  of  the  characteristic  polynomial 
of  Y, (s)/R, (s)  are  entered  in  ascending  order,  the  coefficient 
of  the  highest  order  term  always  being  unity. 

The  subprogram  then  returns  to  read  option  P  or 
F  and  the  second  decoupled  subsystem  desired  closed-loop  poles, 
and  so  on  for  the  M  subsvstems. 
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The  design  of  a  decoupled  system  requires  two 
separate  runs  of  the  subprogram.   First  the  user  must  determine 
if  it  is  possible  to  decouple  the  system  and,  if  so,  obtain  the 
order  of  each  decoupled  subsystem  Y.(s)/R.(s).   This  is  done 
by  leaving  the  option  card  blank.   The  order  of  the  denominator 
polynomial  becomes  the  order  of  each  decoupled  subsystem 
which  determines  the  number  of  poles  or  the  degree  of  the 
characteristic  polynomial  to  be  selected  for  closed-loop 
calculations . 

Options  P  or  F  are  selected  for  the  second  run 
and  the  subprogram  computes  the  control  law  u(t)  which 
decouples  the  system  and  places  the  poles  at  the  selected 
locations.   The  following  input  format  table  summarizes  the 
pertinent  information. 


Entry     Input  Description 

1  Problem  identification,  order 
of  the  system  (N  <_  10)  ,  number 
of  inputs  and  number  of 
outputs  (M  >_  10) 

2  A  matrix  (NXN)  (one  row  per 
card  for  N  <_  8;  one  row  per 
two  cards  for  N  >  8) 

3  BT  matrix  (M*N)  (one  row 
per  card  for  N  <_   8;  one 
row  per  two  cards  for 

N  >  8) 

4  C  matrix  (M*N)  (one  row  per 
card  for  N  <_   8  '    one  row 
per  two  cards  for  N  >  8) 


Format    Columns  Used 

5A4,  212   1-10,  21-22, 
23-24 


8F10.3 


8F10.3 


8F10.3 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 


1-10,  11-20, 
21-30,  etc. 
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Entry 

5 
option 


(iff 

option 

=P) 


Input  Description 

blank  =  analysis  only 
Option   P  =  closed-loop 

polynomial  input 
F  =  closed- loop  poles 

input 

Polynomial  coefficients  in 
ascending  power  of  s 
(see  complete  description 
P-  31  ) 


Format   Columns  Used 
Al       1 


8F10.3 


1-10,  11-20, 
21-30,  etc. 


(iff 

option 

=F) 


Roots  of  characteristic  poly- 
nomial (one  root  per  card) 
(see  complete  description 
P-  32  ) 


8F10.3 


1-10,  11-20, 
21-30,  etc. 


The  above  information  should  become  clear  from  the  example 
presented  in  part  c. 

b.   Output 

T 
The  problem  identification,  A,  B   and  C  are  listed 

for  reference.   Then  the  decoupled  phase  variable  represen- 
tation of  each  subsystem  is  printed.   The  denominator  poly- 
nomial in  ascending  powers,  of  sis  given  first,  followed  by 
the  numerator  polynomial  both  in  unfactored  and  factored  form. 
It  should  be  noted  that  the  subprogram  outputs  the  cancelled 

zeros  of  Y. (s)/R. (s)  as  well, 
l   "  l 

If  closed-loop  calculations  have  been  requested, 
by  letting  option  equal  P  or  F,  each  subsystem  closed-loop 
polynomial  is  printed  again  both  in  unfactored  and  factored 
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form.   Finally  the  feedback  gain  matrix  F  and  the  control 
gain  matrix  G  are  presented. 

In  terms  of  the  original  system,  the  resulting 
closed-loop  decoupled  system  is 

x(t)   =  A  x(t)  +  B  u(t) 

y(t)   =  C  x(t) 

u(t)   =  F  x(t)  +  G  r(t) 

or,  in  a  form  suitable  for  graphical  time  response  simulation, 

x(t)   =  (A  +BF)  x(t)  +  BGr(t) 

y(t)   =  C  x(t) 

It  must  be  pointed  out  that  not  every  system  can 
be  decoupled.   If  it  cannot,  the  subprogram  is  interrupted 
and  the  message  "BSTAR  IS  SINGULAR  -  THIS  SYSTEM  CANNOT  BE 
DECOUPLED"  is  printed.   It  is  also  possible  that  a  subsystem 
may  be  uncontrollable.   This  is  indicated  as  such  on  the 
output  listing. 

c.   Example 

A  two- input  two-output  system  [13]  is  to  be 
decoupled  both  during  transient-period  and  steady-state. 
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The  first  subsystem  must  approach  a  second  order  response  to 
a  step  input  with  a  natural  frequency  of  10,  a  damping  factor 
of  0.4  and  no  steady-state  error.   The  second  subsystem  must 
also  approach  a  second  order  response  to  step  input  but  with 
a  natural  frequency  of  4,  a  damping  factor  of  0.6  and  no 
steady-state  error. 

The  original  system  is  shown  both  in  block  diagram 
and  signal  flow  graph  form  in  Figures  3-4  8  and  3-49. 


u1(t) 

sfH 

y,(t) 

1 
s  +  7 

N 

1 
s  +  12 

± 

-  p 

S 

T 

2   < 

-   k 
4    { 

u     (t) 

Yo(t) 

u2 

1 
s  +  43 

J^ 

, ^ 

1 
s  +  2 

J2 
^ 

J 

Ai 

^ 

s 

Fig  3-4  8  Multiple-Input  Multiple-Output  Control 
System  (Block  Diagram) 
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uno >- 


1 


u 


20 >■ 


1 


-4.3 


Fig  3-49  Multiple-Input  Multiple-Output 

Control  System  (Signal  Flow  Graph) 


The  state  variable  and  output  equations  can  be  directly 
written  as 


x1      =   -12x1  +  x2  +  2x3 


x2   =   -7x2  +  ux 


x3   =   4xx  -  2x3  +  x4 


x4   =   -4.3x4  +  u2 


y,     =  xx 


y0  =  x. 
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From  these,  the  matrices  A,  B  and  C  are  se 


en 


to  be : 


A  = 


B' 


-12 
0 
4 
0 


C   = 


[: 
[: 


i 

-7 

0 

0 

1 
0 

0 
0 


2 
0 

-2 
0 

0 
0 

0 

1 


0 
0 

1 

-4.3 


:] 


A  first  run  of  the  subprogram  can  be  made  to 
verify  if  it  is  possible  to  decouple  the  system  and  find  the 
order  of  each  subsystem.   The  computer  cards  are 
//  (standard  OS  JOB  card) 
// a  EXEC.LINCON 
//LINK.SYSIN  ~  DD„* 
a* INCLUDE aSYSLIB(MIMO) 

/* 

//GO. SYS IN  .  DD.* 
MIMO  TEST  ONE     040202 
-12.      1.0      2.0      0.0 
0.0       -7.0     0.0      0.0 
4.0       0.0      -2.0     1.0 
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0.0 

0.0 

0.0 

-4.3 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

(blank 

card) 

/* 

The  result  shown  in  Fig.  3-50  reveals  that  both 
subsystems  are  second  order.   The  closed-loop  pole  locations 
can  then  easily  be  selected  for  each  subsystem.   For  the  first 
one,  a  second  order  response  is  desired  such  that  go   =10, 
5  =  0.4.   Thus, 


2  2       2 

s   +  2Coo  s  +  w    =   s   +  8s  +  100 
n     n 


For  the  second  subsystem,  the  desired  response  requires  that 

co   =  4  and  £  =  0.6,  so 
n 


2  9       2 

s   +  2?co  s  +  oj    =   s   +  4.8s  +  16 
n     n 

=   (s  +  2.4  +  J3.2)  (s  +  2.4  -  J3.2) 

The  computer  deck  is  then  modified  as  follows: 

//  (standard  OS  JOB  card) 

//  a  EXECsLINCON 

//LINK.SYSIN  *  DD~* 

^INCLUDE^SYSLIB  (MIMO) 

/* 
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MULT  t-IMPUT.    MULTI-nuTfUT    PRCGf^AK 

PeCtHeM    IDEMtMCATICN  -  "11*3   TC«;T    CNc 


1>?    A    MATRIX 

-l.?3000E    CI 
0.0 

t.CCCOCE    00 
3.0 

I..JCGCCE 
-7.C0CC0E 
0.0 
0.0 

00 
00 

2.00000= 
0.0 
-2.Q0000E 
CO 

00 
00 

0.0 
0.0 

l.OOOOOE 
-*.300C0E 

00 
00 

THE    B    MATRIX 

3.0 
0.0 

l.OOCCOE 
0.0 

00 

c.c 

CO 

0.0 

l.OOOOOE 

00 

THE    C    MATRIX 

l.CCCOC?    00 
3.0 

CO 
0.0 

CO 
l.OOOOOE 

0  0 

0.0 
0.0 

DECOUPLER    PHASE    WMARLE    REFF  ESENT*TmN 
•**«    SORSTSTEM      1 

DENJTiATOP    PCCYNCUL   -    IN    ASCFNnpjr.    RCWERS   OP   S 
1.90735F-0*         -3.81470E-06  I.CCOOOE    00 

NIM=&»T0R    POLYNOMIAL    -    IN    ASCENDING    POWERS    CF    S 
t.OOJOOP    00 
••••    SC-RSYSTEM      2 

DENOMINATOR    POLYNOMIAL    -    IN    ASCENOING    PCWERS    OF    S 
0.0  0.0  l.OOOOOE    00 

NUMERATOR    POLYNTMIAL   -    IN    ASCENDING    POWERS   OF    S 
l.CCOOCE    00 


Figure   3-50     Computer  Output   for  MIMO  Test  One 
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//GO 

.SYS IN-  DD-* 

MIMO 

TEST 

TWO 

040202 

-12.0 

1.0 

2.0 

0.0 

0.0 

-7.0 

0.0 

0.0 

4.0 

0.0 

-2.0 

1.0 

0.0 

0.0 

0.0 

-4.3 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

1.0 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

P 

100. 

8.0 

1.0 

F 

2.4 

3.2 

/* 

From  the  results  given  in  Fig.  3-51,  the  decoupled 
compensated  system  can  be  written  in  terms  of  the  original 
system. 

x(t)   =   A  +  BF  x(t)  +  BG  r(t) 


-12  1  2    0 

-156  4  "12  -2 

4  0  -2    1 

36.8  -4  -18.4  -2.8 


x(t)  + 


0 

0 

100 

0 

0 

0 

0 

L6 

r(t) 
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MOLTI-tNPttT,  ►ULTI-CUTPUT  PHCCRAM 

PROBLEM  IDENTIFICATION  -        MIMQ  T=ST  TWO 


THE     A    MATRIX 

-1.200006    01 

<».UJwJOE    JO 
0.0 

l.COCCOF 
-7.JCCC0E 
0.0 
0.0 

00 
CO 

2.00000= 

c .  c 
-2^000006 

CO 

00 
00 

0.0 
0.0 

1.00000? 
-4  .300006 

00 
00 

THF    B    MATRIX 

O.J 
0.0 

l.OCCCOE 
0.0 

00 

CO 
CO 

0.0 
1.000006 

00 

The    C    MATRIX 

l.OOJOOE    00 
0.0 

0.0 
0.0 

cc 

1.00000= 

00 

0.0 
0.0 

OECGUPLEO  FMASE  VARIABLE  REPRESENTATION 
•*•«  SUBSYSTEM   1 

DENOMINATOR  POLYNOMIAL  -  IN  ASCENDING  POWFRS  OF  S 
1.90735E-C6    -3.Bl<i7JE-C«>     1.00000=  00 

NUMERATOR  POLYNOMIAL  -  IN  ASCENDING  POWERS  OF  S 
l.OOJOOE  00 
•*••  SUBSYSTEM   2 

DENOMINATOR  POLYNOMIAL  -  IN  ASCENDING  POWERS  OF  S 
J.O  0.0  1.CC0005  00 

NUMERATOR  POLYNOMIAL  -  IN  ASCENOlNH  POWERS  OF  S 
l.OOOJCF  CO 

CLOSEO-LOOP  CALCULATICNS 

**••  SUBSYSTEM   1 

CLOSED-LOOP    POLYNOMIAL    -     IN    ASCENDING    POWERS    OF    S 
1.00000=    02  8.0OCC0E    00  l.JOOOOE    00 


CLOSEO-LOOP    POLES 


R6«L    PAOT 
-*.CCCC000C    00 

-4.CC000006  no 


IMAGINARY  PART 
— J.1651516E  00 
9.1651516E  OJ 


***•  SCRSVSTCM  I 

CLOSEO-LOOP  POLYNOMIAL  -  IN  ASCENTING  POWERS  OF  S 
l.bCOOOF  01     t.dOOCCE  00     l.OCOOO"  00 
CLOSED-LOJP  POLES 


REAL    P4PT 
-2.?CS°<»96=,    00 
-2.3999996=    00 

«•***•«••••  •  *****«*****'**  ******************** 

ORIGINAL    STATE    VARIABLES 

FEEDBACK    GAIN    MATPIX 


IMAGIM4RY    PART 
-3.200000aE    00 
3.200000^6    00 


-l.it.J00E    02 

3.6-000  =    01 


1.100CJF    01 
-4.GJJC0E   00 


1.20000=    01 
-1.8*000=    01 


-2. 
1. 


00000=    00 
50000E    00 


CONTROL    GAIN   MATRIX 


l.JOOOOE    02 
0.0 


0.0 
1.600C0E   01 


Figure  3-51  Computer  Output  for  MIMO  Test  Two 
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y1(t)   =  x1(t) 


y2(t)   =  x3(t) 


For  comparison  with  the  actual  results  given  in 
[13 ] ,  the  decoupled  compensated  system  was  simulated 
using  the  subprogram  GTRESP,  for  a  unit  step  input.   Note 
that  since  GTRESP  only  allows  for  single-input  single-output 
simulation,  two  runs  must  be  made.   The  data  for  the  sub- 
program is 

r(t)   =   1.0 


A  = 


-12 

-156 

4 

36.8 


1 

4 

0 

-4 


2 
12 
-2 

■18.4 


0 
-2 

1 
-2.8 


b   =   [0    100    0     0]  ,   for  the  first  channel 


b   =   [0    0    0     16]   ,   for  the  second  channel 


c   =   [1    0    0    0]  , 


for  the  first  channel 


c   s   [o    0     1    0]  ,      for  the  second  channel 


kT  =   0 
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K   =   1 


x(tQ)   =   0 


TZERO   =0.  TF   =   10. 

DT   =   0.01  FREQ   =   20 

The  output  y,  (t)  and  Yo^t)  were  to  be  plotted  for 
the  first  and  second  run,  respectively.   The  complete  com- 
puter deck  for  GTRESP  follows. 
//  (standard  OS  JOB  card)  ,TIME=2 
//  *  EXECLINCONF 
//FORT. SYS IN  * DD.* 

SUBROUTINE  RFIND(T,R) 

R=1.0 

RETURN 

END 

/* 

//LINK.SYSIN.DD.* 

„. INCLUDE^ SYS LIB (GTRESP) 

„„ ENTRY.  GTRESP 


/* 

//GO. SYS IN. DD. 

* 

GTRESP  MIMO 

04 

-12.0      1.0 

2.0 

0.0 

-156.0     4.0 

12.0 

-2.0 
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4.0 

0.0 

-2.0 

1.0 

36.8 

-4.0 

-18.4 

-2.8 

0.0 

100.0 

0.0 

0.0 

1.0 

0.0 

0.0 

0.0 

0.0 

1.0 

0.0 

0.0 

v 

10.0 

0.01 

20. 

I 

/* 

T 
Note:   these  b,   and  c 

matrices  are  for 

the  first  channel 

simulation 


For  the  second  channel,  the  subprogram  is  run  a  second  time 

T 
changing  the  b   and  c  matrices  appropriately.   Figures  3-52A 

and  3-52B  show  that  the  response  effectively  meets  the 

specifications  given  initially. 
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IV.   CONCLUSIONS  AND  RECOMMENDATIONS 

The  eighteen  subprograms  presented  in  the  third  chapter 
constitute  the  actual  linear  control  subroutine  library  and 
this  thesis,  the  user's  manual  that  goes  with  it.   The  sub- 
programs are  easy  to  access  and  have  proven  to  work  well. 
(They  were  all  tested  by  solving  several  textbook  problems 
and,  hopefully,  all  the  "bugs"  have  been  eliminated.)   Very 
little  programming  is  necessary  so  the  user  can  concentrate 
on  control  problems  rather  than  worry  about  computational 
details.   The  LINCON  library  is  indeed  a  nice  tool  for 
analysis  and  design  of  linear  control  systems. 

Furthermore,  the  library  can  still  be  easily  improved  and 
expanded.   Any  FORTRAN  subroutines  can  be  modified  and 
replaced  or  new  subroutines  added  by  following  the  simple 
instructions  given  in  Appendix  A.   Note  that,  as  was  done  in 
reference  [1] ,  the  subprograms  were  written  to  handle 
systems  of  order  less  than  or  equal  to  ten.   This  should 
take  care  of  most  of  the  problems  encountered.   If,  however, 
it  becomes  necessary  to  solve  higher  order  systems  using 
these  subprograms,  remember  that  it  can  easily  be  accom- 
plished by  re-dimensioning  the  arrays  of  the  appropriate 
subroutines  and  replacing  them  in  the  load  module  (again 
following  the  procedure  given  in  Appendix  A) . 

Finally,  the  following  recommendations  should  be  taken 
into  consideration 
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(1)  by  the  users, 

always  use  the  proper  job  control  language 
cards  (i.e.,  the  ones  described  in  Chapters 
II  and  III)  to  access  the  subprograms. 

(2)  by  the  future  LINCON  library  "programmer", 

-  before  making  any  changes,  be  certain  the 
control  cards  are  exactly  those  required 
for  the  job.   Double  checking  with  a 
consultant  is  always  a  good  idea, 
always  keep  a  copy  of  the  subroutines ' 
listings  and  the  card  decks.   It  is  not 
possible  to  obtain  any  listings  or  card 
decks  from  a  load  module. 

-  every  modification  should  be  documented 
(complete  with  examples)  and  the  information 
distributed  to  the  users. 

after  changes  have  been  implemented  and 
tested,  a  back-up  copy  of  the  new  LINCON 
data  sets  should  be  created  to  replace  the 
one  on  magnetic  tape  (as  specified  in 
Appendix  A) . 
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APPENDIX  A 
The  LINCON  Data  Sets 

All  the  linear  control  subprograms  described  in  Chapter 
III  were  placed  in  a  load  module  (pre-processed  by  the 
linkage  editor)  on  Disk  02  of  the  Naval  Postgraduate  School 
OS/MVT  IBM/360.   Procedures  were  cataloged  so  anyone  can 
easily  access  the  subprograms  under  OS  Batch.   The  job  con- 
trol language  cards  to  be  prepared  to  use   the  load  module 
linear  control  library  are  given  in  Chapter  II. 

The  following  paragraphs  now  present  the  actual  content 
of  the  load  module  and  explain  the  procedures  to 

-  modify  or  add  members 

-  change  the  data  set's  expiration  date 

-  delete  the  data  sets 

-  list  the  member  names  and  check  the  disk  space 

-  compress  the  data  sets. 

Also,  since  a  back-up  copy  of  the  data  sets  was  created,  the 
procedure  to  restore  the  load  module  linear  control  library 
is  given  as  well. 

However,  before  any  attempt  is  made  to  "play"  with  the 
load  module,  it  is  suggested  that  the  programmer  familiarize 
himself  with  the  latest  computer  procedures  and  the  linear 
control  subroutine  library.   References  14  and  15  should 
also  be  read. 
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1.  Content  of  The  Library. 

The  linear  control  subroutines  library  contains  a 
total  of  fifty-two  subroutines.   These  are  given  in  Table 
A-l  indicating  what  subroutines  are  used  by  the  subprograms. 
A  detailed  description  of  most  of  the  subroutines  is  presented 
in  [1] .   Note  that  several  minor  changes  had  to  be  made  to 
the  subroutines  in  order  to  implement  the  library.   These 
modifications  do  not,  however,  change  the  purpose  or  the 
efficiency  of  the  programs.   Anyone  interested  in  the  pro- 
gramming aspects  of  the  library  must  utilize  both  the  sub- 
routine listings  and  reference  [1] . 

2.  Data  Sets  Utilities 

It  is  probable  that  the  content  of  the  LINCON  sub- 
routines library  will  have  to  be  modified  at  one  time  or 
another.   The  following  paragraphs  outline  the  procedure 
and  give  the  job  control  language  cards  necessary  to  carry 
out  the  changes. 

a.   Data  Set  Listing 

The  following  set  of  control  cards  is  used  to 
list  the  load  module  library  content  and  the  spaces  it  occupies: 
//   (standard  OS  JOB  card) 
/A  EXEC~PGM=IEHLIST 
//SYSPRINT/s  DD  ^  SYSOUT=A 
//DDL  DD  „UNIT=3330,VOL=SER=DISK02,DISP=SHR 

//SYSIN  ^  DD  ^  * 

~  „  LISTVTOC  .FORMAT , VOL=3330=DISK02 ,DSNAME=F0718 . LINCON 

-  -  LISTPDS  ~  VOL=3330=DISK02,DSNAME=F0718. LINCON 

/* 
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*     *  * 


Eh  CO  O.  Z  >  en     U  H  Ph     Eh  S 
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X 

X     X 
x  XXX 

X 


X 
X 


CALCU  x 

CHREQ  x 

CHREQA  x  x 

DET  x 

DIVP 

DMULT  X  X 

FORM  x 

GRAPH  x 

HERMIT  x  xx 

LINEQ  x 

MAXI  x 

MPY 

MULT  x  xx 

NORMP  x 

PADD  X 

PEXCG  x 

PFEXP  X 

PHNOM  x 

PMUL  X 

POLRT  X 

PROOT  xx  x  xxx  xxx        x 

PVAL  x  x 

RUNGE  •  x 

SEMBL  x      xxx        xx 

SIMEQ      x  X  ;  X 

SIMUL  x  x  x 

SORT  X 

SPLIT  x  xxx 

STMST      x  x 

SUBP  x 

TRESP  x 

VECTEQ  x 

YDOT  X 

Y8VSX  x 


Table  A-l   Subroutines  Cross  List 

(*)   These  subprograms  were  loaded  with  all  their  necessary- 
subroutines.   Each  one  of  them  requires  an  external  subroutine 
(see  Chapter  III) . 

(**)   The  subprogram  MAIN  is  used  to  call  all  the  sub- 
programs (operation  under  Mode  Three) .   It  requires  4  50K  core. 
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All  the  subprograms  and  subroutines  names  are 
listed  in  alphabetical  order  and  the  space  occupied  and 
unoccupied  given  in  terms  of  number  of  tracks  and  number 
of  cylinders. 

b.  Changing  Expiration  Date 

The  expiration  date  of  the  subroutine  library 
must  be  changed  approximately  every  six  months.   The  control 
cards  used  to  perform  the  task  are: 
//   (standard  OS  JOB  card) 
//*  EXEC*  PGM=CEXPDATE 
//SYSPRINT^  DD.  SYSOUT=A 

//DD1~  DD  ^UNIT=3330,VOL=SER=DISK02,DSIP=OLD,DSN=F0718.LINCON, 
//*  LABEL=EXPDT=yyddd 
/* 

where  yy=year   (e.g.  80) 

and  ddd=day     (e.g.  365) 
The  last  expiration  date  given  was  80182,  i.e.  01  July  1980. 
The  computer  centre  normally  sends  a  reminder  listing  the 
data  sets  that  are  about  to  expire. 

c.  Adding  New  Members  or  Replacing  Existing  Ones 
The  following  control  cards  are  required  to  add 

a  new  member  or  replace  an  existing  one: 
//   (standard  OS  JOB  card) 

//  ~  EXEC  ~  FORTCL,  PARM.LINK= 'NCAL, MAP , LIST' 
//FORT,  SYS  IN  ,DD.* 

Subroutine  to  be  modified  or  added 

/* 
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//LINK.SYSLMOD^  DD/NUNIT=3330  ,  VOL=SER=DISK02  ,DISP=SHR, 
//  ~DSN=F0718.LINCON(member) 
/* 

where  "member"  is  the  name  of  the  subroutine  to  be  modified 
or  added.   Note  that  the  complete  set  of  cards  representing 
the  subroutine  called  "member"  must  be  included.   Before 
placing  the  subroutine  in  the  load  module  library,  the  com- 
puter compiles  it.   If  any  error  is  found,  the  linkage  is 
not  executed  and  the  new  subroutine  is  not  placed  in  the  load 
module.   The  user  must  carefully  check  the  computer  output 
and  make  sure  the  message  "member  now  replaced  in  data  set" 
is  printed.   If  not,  he  must  correct  any  error  and  redo  the 
procedure.   Note  that  a  lack  of  space  can  also  prevent  the 
computer  from  linking  to  the  load  module.   If  this  last 
situation  occurs  the  user  should  run  the  "data  set  listing" 
(part  a)  control  cards  to  see  how  much  space  is  available. 
If  sufficient  space  can  be  allocated,  he  must  run  the 
"compressing  data  sets"  control  cards  (part  e)  to  release 
any  unused  space  in  the  data  sets  and  then  execute  the 
addition  or  replacement. 

d.  Removing  Data  Sets 

It  is  sometimes  necessary  to  remove  undesired 
members  from  the  library  (to  create  space  or  erase  useless 
programs) .   The  following  control  cards  are  used  to  delete 
one  or  several  members  from  the  subroutine  library: 
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//   (standard  OS  JOB  card) 

//«   EXEC-  PGM=IEHPROGM 

//SYSPRINT-  DD-  SYSOUT=A 

//DD1  -  DD-  UNIT=3330,VOL=SER-DISK02,DISP=SHR 

//SYS IN-  DD-  * 

-  -  SCRATCH-  VOL=3330=DISK02/PURGE/DSNAME=F0718.LINCON/MEMBER=memberl 

-  -  SCRATCH-  VOL=3330=DISK02,PURGE,DSNAME=F0718.LINCON,MEMBER=member2 
/* 

where  memberl  and  member2  are  the  subroutines  to  be  erased 
from  the  module.   Here  the  programmer  must  be  extremely 
careful  while  using  this  utility.   Mistakes  can  be  very 
costly  (from  scratching  the  wrong  subroutine  to  erasing  the 
whole  subroutine  library) .   For  instance,  using 

SCRATCH  VOL=3330=DISK02, PURGE, DSNAME=F0718. LINCON 
would  erase  the  entire  LINCON  subroutine  library.   Be  careful. 

Also  note  that  scratching  a  member  does  not  make 
the  space  it  occupied  immediately  available.   The  "compressing 
data  sets"  utility  must  be  run  to  release  the  space  (see 
part  e) . 

e.   Compressing  Data  Sets 

The  following  control  cards  are  used  to  free 
unavailable  space  in  the  data  set: 
//   (standard  OS  JOB  card) 
//-  EXEC-PGM=IEBCOPY,REGION=100K 
//SYSPRINT-  DD-  SYSOUT=A 

//DD1-  DD  ~UNIT=3330,VOL=SER-DISK02,DSN=F0718. LINCON ,DISP=OLD 
//SYSUT3-  DD  ~UNIT=SYSDA,SPACE=(CYL, (1,1) ) ,013?= (.DELETE) 
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//SYSUT4 *  DD  -UNIT=SYSDA,SPACE=(CYL, (1,1) ) ,013?= (, DELETE) 
//SYSIN  ~ DD  -* 
-  -  COPY-  OUTDD=001,INDD=DD1 
/* 

Note  that  the  use  of  this  utility  is  somewhat 
dangerous  since  a  power  failure  or  a  machine  check  during 
compression  will  make  the  data  set  unaccessible  by  any 
program  [13] . 

3.   Back-up  Copy 

A  back-up  copy  of  the  partitioned  data  sets  was  made 
by  copying  them  onto  the  magnetic  tape  NPS  705,  file  01. 
The  control  cards  that  were  used  to  create  it  are: 
//   (standard  OS  JOB  card) 
//ONE  -EXEC-  PGM=IEHMOVE/REGION=80K 
//SYSPRINT  -  DD  -  SYSOUT=A 

//SYSUT1  -  DD  -UNIT=SYSDA,SPACE=(CYL, (3,1) ) 
//DDX  -DD  -UNIT=3330,VOL=SER=DISK02,DISP=SHR 

//TAPE  -DD  /vUNIT=3400-3/VOL=SER=NPS705,DISP+(/PASS)  ,DCB=DEN=3 
//SYSIN-  DD  -  *  in  column  72 

COPY-  PDS+F0718.LINCON,TO=3400-3=(NPS705,1) ,  X 

FROM=3330=DISK02/TODD=TAPE 
/*  in  column  16 

Since  it  is  possible  that  the  data  sets  i:may  be 
lost  one  way  or  another,  it  is  imperative  to  have  such  a 
back-up  copy.   To  restore  the  LINCON  data  sets,  the  programmer 
must  first  re-allocate  space  by  running  the  following  job 
control  cards: 
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//      (standard  OS   JOB   card) 

//TWO-   EXEC   ~PGM=IEFBR14 

//DDL    ~   DD   * UNIT=3330,VOL=SER=DISK02 ,013?= (NEW, KEEP) , 

//   ^DSN=F0718.LINCON,LABEL=EXPDT=yyddd,SPACE=(Cyl, (2,1,10) ) 

/* 

where  yy=expiration  year 

ddd=expiration  day 

Finally,  to  restore  the  data  sets  one  only  has 

to  run  the  program  given  below. 

//   (standard  OS  JOB  card) 

//THREE  *  EXEC  -  PGM=IEHMOVE,REGION=80K 

//SYSPRINT  -  DD  -  SYS0UT=A 

//SYSUT1  -  DD  -  UNIT=SYSDA,SPACE=(CYL, (3,1) ) 

//DDX     -  DD    -  UNIT=3330,VOL=SER=DISK02,DISP=SHR 

//TAPE     -   DD    -  UNIT=3400-3,VOL=SER-NPS705,DISP= (OLD, PASS) ,DCB=DEN=3 

//SYS  IN    -  DD    -  *  column  72 

i 
~~      COPY-  PDS=F0718.LINCON,TO=3330=DISK02,  X 

FR0M=  3400-3=(NPS705,l), FROMDD=TAPE 
t 
/*  column  16 
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APPENDIX  B 
List  of  the  Sources  for  the  Examples  of  Chapter  III 

The  following  table  lists  the  references  from  which 
the  examples  worked  out  in  Chapter  II  originated. 


Section     Example 
IIIB        l.c 

2 .  c 


IIIC 


HID 


3.c 

3.d 
2.c 
3.c 

l.c 
2.c 

3.c 
4.c 


Reference 

Eveleigh,  V.W.,  Introduction  to 
Control  System,  p.  568  (#3) , 
McGraw-Hill,  19  72. 

Shinners,  S.M.,  Modern  Control 
System  -  Theory  and  Application, 
2nd  ed.,  p.  364  (#7.26),  Addison- 
Wesley,  1978. 

Brogan,  W.L. ,  Modern  Control  Theory, 
p.  35  (#2.10),  Quantum  Publishers, 
1974. 

Ogata,  K.,  Modern  Control  Engineering, 
p.  517,  Prentice-Hall,  1970 

Ogata,  K. ,  Modern  Control  Engineering, 
p.  275,  Prentice-Hall;  1970 

Kirk,  D.E.,  Optimal  Control  Theory  - 
An  Introduction,  pp.  34-42,  Prentice- 
Hall,  1970. 

Ogata,  K. ,  Modern  Control  Engineering, 
p.  797,  Prentice-Hall,  1970. 

Kirk,  D.E.,  Optimal  Control  Theory  - 
An  Introduction,  p.  28,  Prentice- 
Hall,  1970. 

Ogata,  K. ,  Modern  Control  Engineering, 
pp.  728-729,  Prentice-Hall,  1970. 

Eveleigh,  V.W. ,  Introduction  to 
Control  System  Design,  pp.  353-356, 
McGraw-Hill,  1972. 
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Section     Example 
5.d 

6.d(l) 

6.d(2) 
7.c(l) 

7.c(2) 

8.c 


9.c 


10.  c 


Reference 

Eveleigh,  V.W.  ,  Introduction  to 
Control  System  Design,  pp.  357- 
360,  McGraw-Hill,  1972. 

Chen,  C.T.,  Introduction  to  Linear 
System  Theory,  p.  296,  Holt, 
Rinehart  and  Winston,  1970. 

Same  as  5.d 

Kirk,  D.E.,  Optimal  Control  Theory  - 
An  Introduction,  p.  41,  Prentice- 
Hall,  1970. 

Kwakernaak,  H.   and  Sivan,  R. , 

Linear  Optimal  Control  Systems , 

pp.  347-351,  Wiley-Interscience,  1972. 

Parker, S.R.,  Digital  Control 
Systems  (Class  Notes) ,  1978. 

Kirk,  D.E.,  Optimal  Control  Theory  - 
An  Introduction,  Prentice-Hall,  1979. 

Mowrey,  J.T. ,  Compensator  Optimization 
in  Multiple  Input  Multiple  Output 
Control  Systems,  pp.  26-27,  Master's 
Thesis,  Naval  Postgraduate  School, 
Monterey,  1979. 


Table  B-l  List  of  References  for  the  Examples 

Worked  in  Chapter  III 
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